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(54) POSTURE CONTROL DEVICE FOR LEG TYPE MOBILE ROBOT 

(57)Abstract: 

PROBLEM TO BE SOLVED: To take dynamic balance so as to continue a 
stable posture even if a leg type mobile robot receives unexpected reaction 
force of an article by providing a joint displacing means for displacing the 
joints of the robot based on a calculated basic target track correction amount 
and a floor reaction force target track correction amount. 
SOLUTION: If an actual upper body position/posture and its changing rate 
detected by an oblique sensor 60 are coincident with a correction target upper 



body position/posture and its changing rate, a target flat sole position/posture 
is corrected so that the moment component of an actual total floor reaction 
force applied to a target total floor reaction force center position is to coincide 
with the resultant force moment component of a target total floor reacting 
force and compensating total floor reaction force for an article reaction force 
parallel control. Further, a leg main control device controls leg joint actuators 
10R (L) and 12R (L) so that an actual joint displacement follow up a target leg 
joint displacement decided based on the correction target upper body 
position/posture and the correction target flat sole position/posture. 
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CLAIMS 



[Claim(s)] 

[Claim 1] In the attitude control equipment of the leg formula mobile robot 
which consists of a link of two or more connected with a base and said base 
at least a. Said robot's movement pattern which contains the target locus of 
said base at least, The target locus of floor reaction force which acts on said 
robot, and the target locus of external force other than the floor reaction force 
which acts on said robot are included at least. A target gait setting means to 
set up said robot's target gait, an external force detection means to detect 
external force other than the b. aforementioned floor reaction force, and the 
external force by which the c. aforementioned detection was carried out, An 
external force deflection operation means to calculate the deflection of 
external force other than the floor reaction force set up by said target locus, d. 
The model expressing the relation of the perturbation of the center-of-gravity 
location of the perturbation of said floor reaction force, and said robot, and/or 
the location of a base, e. An amount operation means of model inputs to 
calculate the amount of model inputs which should be inputted into said model 
based on the deflection of said calculated external force at least, f. Input said 
calculated amount of model inputs into said model, and correct the target 
locus of said base according to the perturbation quantity of said center-of- 
gravity location obtained and/or a base, the amount operation means of base 
target locus corrections and g. which calculate the amount of base target 
locus corrections -- according to said calculated amount of model inputs, the 
target locus of said floor reaction force is corrected at least -- an amount 
operation means of floor-reaction-force target locus corrections to calculate 
the amount of floor-reaction-force target locus corrections, and h. — the joint, 
to which the variation rate of said robot's joint is carried out based on said 
amount of base target locus corrections and amount of floor-reaction-force 
target locus corrections which were calculated at least — a variation rate — a 
means — Attitude control equipment of the leg formula mobile robot 
characterized by preparation ******. 

[Claim 2] Said amount operation means of model inputs is attitude-control 
equipment of the leg formula mobile robot given in claim 1 term characterized 
by to calculate said amount of model inputs so that it may have a balanced 



center-of-gravity location perturbation-quantity calculation means compute the 
perturbation quantity of the balanced center-of-gravity location which balances 
the j. aforementioned external force statically and said model may converge 
on said computed balanced center-of-gravity location. 

[Claim 3] Claim 1 term characterized by being the model to which said model 
approximates said robot with a handstand pendulum, or attitude control 
equipment of a leg formula mobile robot given in dyadic. 
[Claim 4] Said balanced center-of-gravity location perturbation quantity 
calculation means is attitude control equipment of claim 2 term characterized 
by having the limiter which restricts the perturbation quantity of the balanced 
center-of-gravity location by which the k. aforementioned calculation was 
carried out to the predetermined range, or a leg formula mobile robot given in 
3 terms. 

[Claim 5] Said amount operation means of floor-reaction-force target locus 
corrections is attitude control equipment of a leg formula mobile robot given in 
either claim 1 term characterized by having the limiter which restricts the 
amount of floor-reaction-force target locus corrections by which the I. 
aforementioned operation was carried out to the predetermined range thru/or 
the 4th term. 

[Claim 6] The target locus of said floor reaction force is attitude control 
equipment of claim 1 term characterized by including at least the locus of the 
target central point of floor reaction force which acts on said robot thru/or a leg 
formula mobile robot given in 5 terms. 

[Claim 7] Said amount operation means of floor-reaction-force target locus 
corrections is attitude control equipment of the leg formula mobile robot given 
in claim 6 term characterized by calculating said amount of floor-reaction- 
force target locus corrections so that said amount of floor-reaction-force target 
locus corrections may balance with the value which subtracted the deflection 
of said external force from said amount of model inputs, and the moment 
which acts on the circumference of the target central point of said floor 
reaction force dynamically. 

[Claim 8] Attitude control equipment of a leg formula mobile robot given in 
either claim 1 term characterized by external force other than said floor 



reaction force being the reaction force from the activity object which acts on 
said robot through said link thru/or the 7th term. 

[Claim 9] Attitude control equipment of a leg formula mobile robot given in 
either claim 1 term characterized by being the leg formula mobile robot with 
which said robot consists of a two feet link connected with said base, and a 
two arms link thru/or the 7th term. 

[Claim 10] In the attitude control equipment of the leg formula mobile robot 
which consists of a link of two or more connected with a base and said base 
at least a. Said robot's movement pattern which includes the target position of 
said base at least, The locus of the target central point of floor reaction force 
which acts on said robot is included at least. Act on said robot through the 
target gait setting means and the b. aforementioned link which set up said 
robot's target gait. An object reaction force detection means to detect the 
reaction force from an activity object, an object reaction force moment 
conversion means to change the object reaction force by which the c. 
aforementioned detection was carried out as the moment of the circumference 
of said target floor-reaction-force central point, d. So that it may balance with 
said changed object reaction force moment dynamically The robot location 
and a posture correction means to correct location and posture of the floor- 
reaction-force moment of the circumference of said target central point, and 
said robot, and e. - the joint which carries out the variation rate of said robot's 
joint to the floor-reaction-force moment of the circumference of said corrected 
target central point based on said robot's location and posture — a variation 
rate - the attitude control equipment of the leg formula mobile robot 
characterized by having a means. 

[Claim 11] In the attitude control equipment of the leg formula mobile robot 
which consists of a link of two or more connected with a base and said base 
at least a. A target gait setting means to set up said robot's movement pattern 
which includes the target position of said base at least, b. An object reaction 
force detection means act on said robot through said link to detect the 
reaction force from an activity object, c. So that it may hang at an object 
reaction force moment conversion means to change said detected object 
reaction force as the moment of the circumference of a predetermined point, 



and the object reaction force moment by which the d. aforementioned 
conversion was carried out dynamically and it may be suited The robot 
location and a posture correction means to correct location and posture of the 
floor-reaction-force moment of the circumference of said predetermined point, 
and said robot, and e. the joint which carries out the variation rate of said 
robot's joint to the floor-reaction-force moment of the circumference of said 
corrected predetermined point based on said robot's location and posture - a 
variation rate - the attitude control equipment of the leg formula mobile robot 
characterized by having a means. 



DETAILED DESCRIPTION 



[Detailed Description of the Invention] 
[0001] 

[Field of the Invention] Even if this invention receives in more detail a leg 
formula mobile robot and the object reaction force which is not especially 
expected in the leg formula mobile robot of a 2-pair-of-shoes walk about a leg 
formula mobile robot's attitude control equipment, its application as **** 
cooperative control of the leg formula migration robot arm equipped especially 
with an arm about the thing which maintains dynamic balance and enabled it 
to maintain the stability of a posture, and a foot is effective. 
[0002] In addition, "object reaction force" is the external force received from 
the environment containing the candidate for an activity on these 
specifications, and the thing except the floor reaction force which acts on a 
robot from a ground plane is used in the semantics which carries out a 
designation. 
[0003] 

[Description of the Prior Art] As a leg formula mobile robot and a thing 
especially equipped with the arm with the leg formula mobile robot of a 2-pair- 
of-shoes walk, "development of the 2-pair-of-shoes bipedal robot which 



compensates 3 shaft moment by upper-part-of-the-body movement" (Robotics 
Society of Japan 1 1 No. 4, May, 1993) is known. This robot has a pendulum 
as a simplified arm, designs beforehand target gaits also including the gravity 
and inertia! force which are generated by shaking this, and he does walk 
control so that it may be followed. 
[0004] 

[Problem(s) to be Solved by the Invention] However, in this conventional 
technique, it is the requisite that an arm does not receive object reaction force. 
Therefore, when the control proposed there was applied not only to a walk but 
to an activity, when the reaction which is not expected for an activity was 
received, ** balance was lost, the posture became unstable, and when the 
worst, there was a possibility of falling. 

[0005] Moreover, an arm is made to shake and these people are also made to 
recover a stable posture, when the leg formula mobile robot of the same kind 
is proposed and frictional force declines in there at the time of a walk by JP,7- 
205069A 

[0006] However, in the leg formula mobile robot which these people proposed, 
since it was separately controlled independently, without a foot and an arm 
cooperating, when the arm was driven, the whole robot ** balance collapsed 
according to the gravity which an arm generates, inertial force, and the 
reaction from the candidate for an activity, and there was a case where a 
robot posture became unstable on the contrary. 

[0007] Therefore, it is in the purpose of this invention offering the attitude 
control equipment of the leg formula mobile robot which is to cancel above- 
mentioned un-arranging, maintains ** balance even if it receives the object 
reaction force which a leg formula mobile robot cannot expect, and enabled it 
to continue a stable posture. 

[0008] The 2nd purpose of this invention is by moving a robot's center of 
gravity to the location which balances statically to it to offer the attitude control 
equipment of the leg formula mobile robot which controlled the inclination and 
the fall effectively, also when object reaction force changes suddenly. 
[0009] The 3rd purpose of this invention is also in the transition stage which a 
robot's center of gravity moves to offer the attitude control equipment of the 



leg formula mobile robot which changes a center-of-gravity location and floor 
reaction force proper, and continued having ** balance maintained, when the 
above-mentioned object reaction force is received. 

[0010] When working by moving an arm by the leg formula mobile robot by 
the pattern of operation which had not been beforehand assumed in the thing 
equipped with an arm, even if the 4th purpose of this invention receives the 
reaction which is not expected gravity and not only inertial force but for [ which 
is generated on an arm ] an activity, it is to offer the attitude-control equipment 
of the leg formula mobile robot which maintains ** balance and enabled it to 
continue a stable posture. 
[0011] 

[Means for Solving the Problem] If it is in claim 1 term in order to attain the 
above-mentioned purpose In the attitude control equipment of the leg formula 
mobile robot which consists of a link of two or more connected with a base 
and said base at least Said robot's movement pattern which contains the 
target locus of said base at least, The target locus of floor reaction force which 
acts on said robot, and the target locus of external force other than the floor 
reaction force which acts on said robot are included at least. A target gait 
setting means to set up said robot's target gait, an external force detection 
means to detect external force other than said floor reaction force, and said 
detected external force, An external force deflection operation means to 
calculate the deflection of external force other than the floor reaction force set 
up by said target locus, The model expressing the relation of the perturbation 
of the center-of-gravity location of the perturbation of said floor reaction force, 
and said robot, and/or the location of a base, An amount operation means of 
model inputs to calculate the amount of model inputs which should be 
inputted into said model based on the deflection of said calculated external 
force at least, Input said calculated amount of model inputs into said model, 
and correct the target locus of said base according to the perturbation quantity 
of said center-of-gravity location obtained and/or a base. According to an 
amount operation means of base target locus corrections to calculate the 
amount of base target locus corrections, and the amount of model inputs by 
which the operation was carried out [ aforementioned ] at least, correct the 



target locus of said floor reaction force, an amount operation means of floor- 
reaction-force target locus corrections to calculate the amount of floor- 
reaction-force target locus corrections, and the joint, to which the variation 
rate of said robot's joint is carried out based on said amount of base target 
locus corrections and amount of floor-reaction-force target locus corrections 
which were calculated at least — a variation rate — it constituted so that it 
might have a means. 

[0012] A "location" is used in semantics including "a location and/or a posture" 
except for a center-of-gravity location here. In addition, a "posture" means the 
sense in three-dimension space like the after-mentioned. 
[0013] Here, more specifically, it is used with "the target locus of floor reaction 
force" in the semantics which contains the target locus of the floor-reaction- 
force central point at least. Moreover, it is as more specifically as "correcting 
the target locus of said floor reaction force" used in the semantics which 
corrects the moment of the circumference of the floor-reaction-force central 
point. 

[0014] Here, it is used in the semantics which not only the detection "that 
detects external force" but presuming using a disturbance observer etc. 
includes. 

[0015] If it was in claim 2 term, said amount operation means of model inputs 
was equipped with a balanced center-of-gravity location perturbation quantity 
calculation means to compute the perturbation quantity of the balanced 
center-of-gravity location which balances said external force statically, and it 
constituted it so that said model might converge on said computed balanced 
center-of-gravity location and said amount of model inputs might be calculated. 
[0016] If it was in claim 3 term, it constituted so that it might be the model to 
which said model approximates said robot with a handstand pendulum. 
[0017] If it was in claim 4 term, said balanced center-of-gravity location 
perturbation quantity calculation means was constituted so that it might have 
the limiter which restricts the perturbation quantity of said computed balanced 
center-of-gravity location to the predetermined range. 

[0018] If it was in claim 5 term, said amount operation means of floor-reaction- 
force target locus corrections was constituted so that it might have the limiter 



which restricts said calculated amount of floor-reaction-force target locus 
corrections to the predetermined range. 

[0019] If it was in claim 6 term, the target locus of said floor reaction force was 
constituted so that the locus of the target central point of floor reaction force 
which acts on said robot might be included at least. 

[0020] If it was in claim 7 term, said amount of floor-reaction-force target locus 
corrections constituted said amount operation means of floor-reaction-force 
target locus corrections so that it might balance with the value which 
subtracted the deflection of said external force from said amount of model 
inputs, and the moment which acts on the circumference of the target central 
point of said floor reaction force dynamically, and said amount of floor- 
reaction-force target locus corrections might be calculated. 
[0021] If it was in claim 8 term, external force other than said floor reaction 
force constituted so that it might be the reaction force from the activity object 
which acts on said robot through said link. 

[0022] If it was in claim 9 term, it constituted so that it might be the leg formula 
mobile robot with which said robot consists of a two feet link connected with 
said base, and a two arms link. 

[0023] In the attitude control equipment of the leg formula mobile robot which 
consists of a link of two or more connected with a base and said base at least 
if it is in claim 10 term Said robot's movement pattern which includes the 
target position of said base at least, The locus of the target central point of 
floor reaction force which acts on said robot is included at least. Act on said 
robot through a target gait setting means to set up said robot's target gait, and 
said link. An object reaction force detection means to detect the reaction force 
from an activity object, an object reaction force moment conversion means to 
change said detected object reaction force as the moment of the 
circumference of said target floor-reaction-force central point, So that it may 
balance with said changed object reaction force moment dynamically The 
robot location and a posture correction means to correct location and posture 
of the floor-reaction-force moment of the circumference of said target central 
point, and said robot, and the joint which carries out the variation rate of said 
robot's joint to the floor-reaction-force moment of the circumference of said 



corrected target central point based on said robot's location and posture - a 
variation rate - it constituted so that it might have a means. 
[0024] In the attitude control equipment of the leg formula mobile robot which 
consists of a link of two or more connected with a base and said base at least 
if it is in claim 1 1 term A target gait setting means to set up said robot's 
movement pattern which includes the target position of said base at least, An 
object reaction force detection means act on said robot through said link to 
detect the reaction force from an activity object, So that it may hang at an 
object reaction force moment conversion means to change said detected 
object reaction force as the moment of the circumference of a predetermined 
point, and said changed object reaction force moment, dynamically and it may 
be suited The robot location and a posture correction means to correct 
location and posture of the floor-reaction-force moment of the circumference 
of said predetermined point, and said robot, and the joint which carries out the 
variation rate of said robot's joint to the floor-reaction-force moment of the 
circumference of said corrected predetermined point based on said robot's 
location and posture — a variation rate - it constituted so that it might have a 
means. 

[0025] Above, a "leg formula mobile robot" contains the leg formula mobile 
robot which receives object reaction force in addition to* an arm. Moreover, if it 
acts on an activity object about a "arm link" even if it is a foot link, it shall be 
regarded as an arm link. For example, in the 6-piece robot of an insect mold, 
in lifting an object using 2 front pieces, suppose that the foot link is regarded 
as an arm link. 
[0026] 

[Function] the external force which a leg formula mobile robot cannot expect 
in claim 1 term — even if it more specifically receives reaction force from an 
activity object, ** balance can be maintained and a stable posture can be 
continued. Furthermore, even if the movement pattern which had not been 
assumed beforehand receives the reaction which is not expected a link, the 
gravity generated on an arm when working by more specifically moving an 
arm, and not only inertial force but for an activity, ** balance can be 
maintained and a stable posture can be continued. 



[0027] Moreover, also when object reaction force changes suddenly, an 
inclination and a fall can be effectively controlled by moving a robot's center of 
gravity to the location which balances statically to it. Moreover, a center-of- 
gravity location and floor reaction force are changed proper, and maintaining 
** balance also in the transition stage which a robot's center of gravity moves, 
can be continued. 

[0028] Also in claim 2 term thru/or the 8th term, it has the same operation as 
claim 1 term, and effectiveness. 

[0029] Even if it receives the reaction which is not expected gravity and not 
only inertial force but for [ which is generated on an arm ] an activity when 
working by moving an arm by the pattern of operation which had not been 
assumed beforehand also in what is equipped with an arm with a leg formula 
mobile robot in addition to the above-mentioned operation and effectiveness if 
it is in claim 9 term, ** balance can be maintained and a stable posture can be 
continued. 

[0030] Also in claim 10 term thru/or the 1 1th term, it has the same operation 
as claim 1 term, and effectiveness. 

[Embodiment of the Invention] Hereafter, the attitude control equipment of the 
leg formula mobile robot applied to this invention with reference to an 
accompanying drawing is explained. In addition, as a leg formula mobile robot, 
a 2-pair-of-shoes bipedal robot is taken for an example. 
[0031] Drawing 1 is the schematic diagram, showing the leg formula mobile 
robot's attitude control equipment on the whole. 

[0032] Like illustration, the 2-pair-of-shoes bipedal robot 1 equips the foot link 
2 of each right and left with six joints (the electric motor which drives it shows 
each joint for the facilities of an understanding). 

[0033] To the order from a top, six joints are the joints 10R and 10L (right- 
hand side is set to R and left-hand side is set to L.) for foot winding of the 
lumbar part. It consists of the same joints 12R and 12L of the roll axes 
(circumference of a Y-axis) of the lumbar part, the joints 14R and 14L of this 
pitching axis (circumference of the X-axis), joints 16R and 16L of the roll axes 
of a knee region, joints 18R and 18L of the roll direction of a foot, and joints 
20R and 20L of this pitching axis below. **** 22R and 22L are attached in a 



foot. 

[0034] In the above, an ankle joint is constituted for a hip joint (or waist joint) 
from joint 10R (L), 12R (L), and 14R (L) by joint 18R (L) and 20R (L). 
Moreover, the thigh links 24R and 24L, a knee joint, and an ankle joint are 
connected for a hip joint and a knee joint by the leg links 26R and 26L. 
[0035] Furthermore, in the high order of the lumbar part, it is the upper part of 
the body (or base.). While 28 shown by the link is prepared, the upper limit is 
equipped with the arm link 3 which consists of seven joints of each right and 
left (the electric motor which drives it shows each joint similarly for the 
facilities of an understanding). 

[0036] Sequentially from a top, seven joints consist of the joints 30R and 30L 
of the roll axes of a shoulder, the joints 32R and 32L of this pitching axis, the 
joints 34R and 34L for winding of an arm, the joints 36R and 36L of the roll 
axes of the elbow section, joints 38R and 38L for wrist winding, joints 40R and 
40L of these roll axes, and joints 42R and 42L of this pitching axis. Hands 
(end effector) 44R and 44L are attached in the point of a wrist. 
[0037] In the above, a wrist joint is constituted for the shoulder joint from joint 
30R (L), 32R (L), and 34R (L) by joint 38R (L), 40R (L), and 42R (L). 
Moreover, the overarm links 46R and 46L, an elbow joint, and a wrist joint are 
connected for the shoulder joint and an elbow joint by the lower arm links 48R 
and 48L. 

[0038] In addition, the control unit 50 which consists of a microcomputer later 
mentioned about drawing 2 is stored in the interior of the upper part of the 
body (base) 28. 

[0039] By the above-mentioned configuration, the foot link 2 can give six 
degrees of freedom about a guide peg on either side, respectively, by driving 
these 6*2=12 piece joints at a proper include angle during a walk, the 
movement toward a request can be given to the whole guide peg, and 
arbitration can be walked around three-dimension space ("*" shows 
multiplication on these specifications). In addition, like the above, the X-axis is 
set as a robots travelling direction (pitching axis), and the Z-axis is set as a Y- 
axis and the direction of a vertical (gravity shaft) for a longitudinal direction 
(roll axes). 



[0040] Moreover, the arm link 3 can give seven degrees of freedom about an 
arm on either side, respectively, and pushing the truck mentioned later etc. 
can work a request by driving these 7*2=14 piece joints at a proper include 
angle. 

[0041] As shown in drawing 1 , well-known 6 axial-tension sensor 56 is 
attached in ****22R (L) of the lower part of an ankle joint, and the 3 direction 
components Fx, Fy, and Fz of floor reaction force and the 3 direction 
components Mx, My, and Mz of the moment which act on a robot from a 
ground plane among the external force which acts on a robot are detected. 
[0042] Furthermore, between wrist joint and hand 44R (L), 6 axial-tension 
sensor 58 of the same kind is attached, and the 3 direction components Fx, 
Fy, and Fz of the other external force which acts on a robot, especially the 
above mentioned object reaction force received from an activity object, and 
the 3 direction components Mx, My, and Mz of the moment are detected. 
[0043] Moreover, the inclination sensor 60 is installed in the upper part of the 
body 28, and the inclination to the Z-axis (vertical axis (gravity shaft)) and its 
angular velocity are detected on it. Moreover, the rotary encoder which 
detects the rotation is prepared and the electric motor of each joint is 
constituted as a foot actuator or an arm actuator with a displacement pickup 
while carrying out the relative displacement of the links 24 and 26R (L) which 
described the output above through moderation and the reducer (not shown) 
which carries out energizing. The output of these 6 axial-tension sensor 56 etc. 
is sent to a control unit 50 (it illustrates only about a robot's 1 right-hand side 
for the facilities of illustration). 

[0044] Drawing 2 is the block diagram showing the detail of a control unit 50, 
and consists of microcomputers. In there, the output of the inclination sensor 
60 etc. is changed into digital value with A/D converter 70, and the output is 
sent to RAM74 through a bus 72. Moreover, the output of the encoder which 
adjoins an electric motor and is arranged in each actuator is inputted in 
RAM74 through a counter 76. 

[0045] In the control unit, the arithmetic unit 80 which consists of a CPU is 
formed, and like the after-mentioned, an arithmetic unit 80 computes a joint 
angular-displacement command (actuator a variation rate command), and 



sends it out to RAM74 so that a robot can continue a stable posture based on 
the gait stored in ROM84. 

[0046] Moreover, an arithmetic unit 80 reads the command and the detected 
actual measurement from RAM74, computes a control value (control input) 
required for the drive of each joint, and outputs it to the electric motor of D/A 
converter 86, the foot actuator which drives each joint through the actuator 
driving gear (amplifier) 88 formed in each joint, and an arm actuator. 
[0047] Drawing 3 is the block diagram showing functionally the configuration 
and actuation of a leg formula mobile robot of attitude control equipment 
(equivalent to the arithmetic unit 80 mainly described above) concerning this 
invention. 

[0048] This equipment is equipment which controls actuation of a foot and an 
arm integrative, and outputs the displacement command to each actuator 
driving gear 88. Like illustration, this equipment consists of a target activity 
pattern generation machine, an object reaction force balance control unit, a 
foot Maine control unit, and an arm Maine control unit. 

[0049] Below, for the facilities of an understanding, the robot activity situation 
shown in drawing 4 is mentioned as an example, and the contents of 
processing of each component of this equipment are explained. In drawing 4 , 
since the absolute value of the real object reaction force received from a truck 
has become small suddenly rather than the target object reaction force 
currently assumed in the target activity pattern while the robot 1 is pushing the 
truck 100, a robot 1 loses balance by this gap, and it considers as the 
situation of inclining before. The equipment concerning the gestalt of this 
operation is controlled to always maintain ** balance also in such a situation. 
[0050] A target activity pattern generation machine generates the target 
activity pattern which is satisfied with the bottom of a certain assumption 
condition of a dynamical equilibrium condition. A target activity pattern is 
expressed by the time amount change pattern of two or more variables. This 
variable consists of a variable expressing movement, and a variable 
expressing the reaction force received from an environment. 
[0051] Here, the variable expressing movement is the group of the variable 
which the posture between each ** can determine uniquely by this. 



Specifically, it consists of a target **** location and a posture, a target upper- 
part-of-the-body location and a posture, and a target hand location and a 
posture. 

[0052] Moreover, the variable expressing the reaction force received from an 
environment consists of the target all-ground-reaction-force central point 
(location) (target ZMP (location)), target all ground reaction force, and target 
object reaction force. 

[0053] Each [ these ] variable is expressed with support-saddle system of 
coordinates. It is the system of coordinates which make a zero the point from 
a support-saddle ankle (intersection of Joints 18 and 20R (L)) to ****22R (L) 
projecting [ perpendicular ], and as shown in drawing 5 and drawing 6 , 
support-saddle system of coordinates are the system of coordinates fixed to 
the floor to which the support saddle touches, and are system of coordinates 
which make the sense in front of support leg Taira the sense of the X-axis, 
and make the sense of a Y-axis, and the direction facing up of a vertical the Z- 
axis sense for facing the left. 

[0054] Below, a detail is explained about each [ these ] variable. 

[0055] When calling the external force except each guide-peg ground bed 

reaction force object reaction force among the external force which a robot 

receives from an environment like the above, target object reaction force is 

the desired value. In the example of drawing 4 , hand 44R (L) is the thing of 

the reaction force received from an object 100. 

[0056] The target object reaction force which a target activity pattern 

generation machine outputs is expressed by the force and the moment which 

act on the circumference of the target all-ground-reaction-force central point 

mentioned later. Incidentally, the moment component of these is important for 

posture stabilization. 

[0057] Explanation of target all ground reaction force and the target all- 
ground-reaction-force central point (location) calls resultant force of the target 
floor reaction force which each **** should receive from a floor during an 
activity the target all ground reaction force of a wide sense. The target all 
ground reaction force of a wide sense is expressed with the force and the 
moment in the target all-ground-reaction-force central point and its point. The 



target all-ground-reaction-force central point is a point on the floor line where 
the circumference moment component of the X-axis and the circumference 
moment component of a Y-axis become 0, when target all ground reaction 
force is expressed with the force and the moment which make the point point 
of application. 

[0058] Target all ground reaction force in a narrow sense means the force and 
the moment at the time of expressing the target all-ground-reaction-force 
central point for it with the force and the moment, having used target all 
ground reaction force of a wide sense as point of application. The target all 
ground reaction force which a target activity pattern generation machine 
outputs is target all ground reaction force in a narrow sense. 
[0059] As long as there is no explanation especially henceforth, target all 
ground reaction force points out target all ground reaction force in a narrow 
sense. In addition, when walking a flat floor line, the point of application of 
target all ground reaction force is usually set up on the floor line. 
[0060] In the field of walk control, the well-known concept of ZMP also 
extends a concept as follows from the former. That is, when resultant force of 
the inertial force, gravity, and object reaction force which are produced by 
movement of a robot is expressed with the force and the moment which make 
the point point of application, the point on the floor line where the 
circumference moment component of the X-axis and the circumference 
moment component of a Y-axis become 0 is called ZMP. ZMP in case a robot 
exercises a target is called Target ZMP (location). 

[0061] Saying that a target activity pattern satisfies a dynamical equilibrium 
condition is that the above-mentioned inertial force, the gravity, the resultant 
force of object reaction force, and target all ground reaction force which are 
produced with a target activity pattern negate each other, and are set to 0. 
Therefore, in order to satisfy a dynamical equilibrium condition, the target all- 
ground-reaction-force central point and Target ZMP must be in agreement. 
[0062] The target activity pattern which is satisfied with a target activity pattern 
generation machine of a dynamical equilibrium condition is generated. 
Therefore, the target all-ground-reaction-force central point (location) which a 
target activity pattern generation machine generates is in agreement with 



Target ZMP (location). 

[0063] A target **** location and a posture, a target upper-part-of-the-body 
location and a posture, and a target hand location and a posture express the 
location and posture of each part which were expressed by the above 
mentioned support-saddle system of coordinates. It is specifically this 
specification and the location of the upper part of the body 28 and its rate 
mean representation points, such as a center-of-gravity location of the upper 
part of the body 28, and the rate of those (variation rate). Furthermore, the 
upper part of the body or the posture of **** means the "sense" in X, Y, and Z 
space. 

[0064] An object reaction force balance control unit and its control make the 
core of control of the gestalt of this operation, and an object reaction force 
balance control unit controls, taking a dynamical equilibrium condition into 
consideration, in order to maintain posture balance. Then, before explaining 
the outline of an object reaction force balance control unit, a dynamical 
equilibrium condition is explained below. 

[0065] The biggest factor that opts for the behavior of an actual robot's 
posture inclination is the balance of the actual moment of force in the 
circumference of the target all-ground-reaction-force central point (namely, 
target ZMP). 

[0066] The moment of force which acts on the circumference of the target all- 
ground-reaction-force central point is enumerated below. 
1) Inertial force moment 2 gravity moment 3 all-ground-reaction-force moment 
4 object reaction force moment [0067] Although the above moment was 
explained also in advance, it is defined below anew. 

[0068] The inertial force moment is the moment produced by change of the 
angular momentum of the robot of the circumference of the target all-ground- 
reaction-force central point. This value is calculated by the Eulerian equation 
and specifically reverses the sign of the first degree differential value of the 
angular momentum of the robot of the circumference of the target all-ground- 
reaction-force central point. 

[0069] The inertial force moment of a target activity pattern is called the target 
inertial force moment. The inertial force moment when the actual robot is 



working is called the real inertial force moment. 

[0070] The gravity moment is the moment to which the gravity which acts on a 
robot's center of gravity acts on the circumference of the target all-ground- 
reaction-force central point. 

[0071] Resultant force of the floor reaction force which acts on each **** is 
called all ground reaction force. The all-ground-reaction-force moment is the 
moment to which all ground reaction force acts on the circumference of the 
target all-ground-reaction-force central point. 

[0072] The reaction force received from an activity object is called object 
reaction force. The object reaction force moment is the moment to which 
activity object reaction force acts on the circumference of the target all- 
ground-reaction-force central point. 

[0073] Now, it is assumed with an ideal foot Maine control device that the 
robot 1 followed to the movement pattern of a target activity pattern faithfully. 
At this time, the real gravity moment of the real inertial force moment 
corresponds with the target gravity moment in accordance with the target 
inertial force moment. 

[0074] On the other hand, the sum of the real inertial force moment, the real 
gravity moment, a real all ground reaction force moment, and the real object 
reaction force moment is surely 0 by the principle (Eulerian equation) of 
dynamics. 

[0075] Therefore, in order for a robot 1 to move as the movement pattern of a 
target activity pattern faithfully, the sum of the target inertial force moment, the 
target gravity moment, a real all ground reaction force moment, and the real 
object reaction force moment must be 0. This is made into conditions 1. 
[0076] However, in fact, the real object reaction force moment is not in 
agreement with the target object reaction force moment, and a difference 
arises. For example, as drawing 4 was described, while doing the activity 
which pushes a truck, it is in the situation which has become small suddenly 
rather than the value which the absolute value of the actual rolling-friction 
force of a truck (namely, target object) assumed. 

[0077] Target object reaction force becomes larger to positive sense than the 
moment which acts on the circumference of the Y-axis of the target all- 



ground-reaction-force central point, the moment to which real object reaction 
force acts on the circumference of the Y-axis of the target all-ground-reaction- 
force central point stops filling conditions 1 with the situation of this drawing, 
and a robot 1 inclines forward. In addition, the sense of the moment makes 
forward the moment which rotates a robot 1 clockwise toward the forward 
direction of an axis of coordinates. 

[0078] In order to satisfy conditions 1 also in such a situation, two kinds of 
technique as follows can be considered. 

[0079] A real all ground reaction force moment is changed so that the 
technique 1 above-mentioned deflection may be negated. A foot Maine 
control unit is specifically ordered so that the negative floor-reaction-force 
moment may be generated in the circumference of the target all-ground- 
reaction-force central point, in a foot Maine control unit, ******** of ****22R (L) 
is lowered in response to this command, and a real all ground reaction force 
moment is made to increase to negative sense. That is, it is made to take a 
posture which straddles on foot. 

[0080] The target inertial force moment and the target gravity moment are 
corrected by correcting the movement pattern of a target activity pattern so 
that the technique 2 above-mentioned deflection may be negated. Specifically, 
the target inertial force moment and the target gravity moment are corrected 
by correcting a target upper-part-of-the-body location and/or a posture. That is, 
it is made to move with the upper part of the body near at hand. 
[0081] With the equipment concerning the gestalt of this operation, both 
technique was performed to coincidence, it corresponded to a quick change 
by mainly using technique 1 in the short term, and ** balance was always 
maintained, completing a real all ground reaction force moment as the original 
target all-ground-reaction-force moment by mainly using technique 2 in the 
long run. 

[0082] Since a real all ground reaction force moment can be quickly changed 
with a foot Maine control unit only by changing the target all-ground-reaction- 
force moment, technique 1 is fit for short-term correspondence. However, if a 
real all ground reaction force moment is changed a lot, the contact pressure 
distribution of ****22R (L) inclines, a feeling of touch-down decreases, and 



when the worst, a part of ****22R (L) will float. Therefore, in the long run, if 
possible, it should return to the original target all-ground-reaction-force 
moment. 

[0083] What is necessary is to shift a center-of-gravity location, and just to 
correct the movement pattern of a target activity pattern by technique 2 so 
that the above-mentioned deflection may be negated with the target gravity 
moment in order to return a real all ground reaction force moment to the 
original target all-ground-reaction-force moment. However, if a center-of- 
gravity location is shifted rapidly, since the excessive target inertial force 
moment will occur in the reverse sense, it is necessary to shift a center-of- 
gravity location slowly. Therefore, technique 2 is fit for long-term 
correspondence. 

[0084] An object reaction force balance control unit is explained on the 
assumption that the above. An object reaction force balance control unit is 
equipment with the above-mentioned control function. 

[0085] The inputs of an object reaction-force balance control unit are a target 
upper-part-of-the-body location and a posture, the target all-ground-reaction- 
force central point (a location), target object reaction force, the detection value 
of a 6 axial-tension sensor 58, a last correction target hand location and a 
posture, a last correction target upper-part-of-the-body location and a posture, 
and a last correction target **** location and a posture (when using an 
approximation operation, in addition, a last correction target hand location and 
a posture, a last correction target upper-part-of-the-body location and a 
posture, and a last correction target **** location and a posture are 
unnecessary) 

[0086] In an object reaction force balance control unit, in order to realize the 
above-mentioned control function, target object reaction force is transposed to 
the detection value of real object reaction force, and a target upper-part-of- 
the-body location and a posture, and target all ground reaction force are 
corrected so that it may be balanced dynamically. The object reaction force 
(namely, corrected target object reaction force) and real object reaction force 
which the activity pattern corrected by this assumes are in agreement, and a 
robot's dynamical equilibrium condition is satisfied. 



[0087] The outputs of an object reaction force balance control unit are a 
correction target upper-part-of-the-body location and a posture, and the 
compensation all ground reaction force for object reaction force balance 
control. 

[0088] A correction target upper-part-of-the-body location and a posture are 
the target upper-part-of-the-body location and a posture corrected by the 
object reaction force balance control unit. The compensation all ground 
reaction force for object reaction force balance control is all ground reaction 
force applied to the target all-ground-reaction-force central point (location) by 
correction. In addition, especially the important components for posture 
stabilization in the inside of the component of the compensation all ground 
reaction force for object reaction force balance control are a circumference 
moment component of the X-axis, and a circumference moment component of 
a Y-axis. 

[0089] In order to satisfy a dynamics equilibrium condition in [ as the 
deflection of both moment shows more correctly sudden change, i.e., drawing 
7 , ] changing in the shape of a step, the deflection of real object reaction 
force and target object reaction force, and if only the behavior of the output of 
an object reaction force balance control unit is described, the moment 
component of the compensation all ground reaction force for object reaction 
force balance control answers quickly according to this difference at first. 
[0090] It sets into the location and the posture in which a correction target 
upper-part-of-the-body location and a posture balance with this deflection 
statically after that after a while, and the moment component of the 
compensation all ground reaction force for object reaction force balance 
control is converged on 0. In addition, a configuration and algorithm 
explanation of an object reaction force balance control unit are mentioned 
later. 

[0091] In drawing 3 , the desired value inputted into a foot Maine control unit 
is the target all ground reaction force and the compensation all ground 
reaction force for object reaction force balance control which act on a 
correction target upper-part-of-the-body location and a posture, a target **** 
location and a posture, the target all-ground-reaction-force central point 



(location), and its point. 

[0092] If the function of a foot Maine control device is said simply, it will be 
equipment which performs to coincidence posture stabilization control which 
operates the actuator (an electric motor and encoders, such as joint 10R (L)) 
of a foot, and follows a target posture, and floor-reaction-force control which 
follows target floor reaction force. In addition, since it is impossible to satisfy a 
target posture and target floor reaction force to coincidence completely, 
suitable adjustment is performed and it is controlled to satisfy both in the long 
run. 

[0093] In order to restore in more detail the real upper-part-of-the-body 
location and posture detected by the inclination sensor 60 to a correction 
target upper-part-of-the-body location and a posture The moment component 
of real all ground reaction force which computes the restoration all ground 
reaction force which the target all-ground-reaction-force central point should 
be made to generate, and acts on the target all-ground-reaction-force central 
point A target **** location and a posture are corrected in order to rotate or 
move ****22R (L) up and down so that it may be in agreement with the 
moment component of resultant force of this restoration all ground reaction 
force, target all ground reaction force, and the compensation all ground 
reaction force for object reaction force balance control. The corrected target 
**** location and posture are called the last correction target **** location and 
a posture. 

[0094] Therefore, if the real upper-part-of-the-body location and posture 
detected by the inclination sensor 60, and its rate of change are in agreement 
with a correction target upper-part-of-the-body location and a posture, and its 
rate of change, they will correct a target **** location and a posture so that the 
moment component of real all ground reaction force which acts on a target all- 
ground-reaction-force central point location may be in agreement with the 
moment component of resultant force of target all ground reaction force and 
the compensation all ground reaction force for object reaction force balance 
control. 

[0095] the target foot joint as which a foot Maine control unit is further 
determined from a correction target upper-part-of-the-body location and a 



posture, and a correction target **** location and a posture » a variation rate - 
- a real joint — a foot actuator is controlled so that a variation rate follows. 
[0096] A foot Maine control system consists of a foot Maine control unit and 
the above mentioned inclination sensor 60, a 6 axial-tension sensor 56 
formed in ****22R (L), an actuator driving gear 88, and an actuator (the 
electric motor for joint 10R (L) thru/or 20R(L), and encoder). 
[0097] The target **** location and posture corrected with the foot Maine 
control unit are sent to an object reaction force balance control unit as the last 
correction target **** location and a posture. However, in an object reaction 
force balance control device, if change of the center-of-gravity location of the 
robot by the target **** location and the posture having been corrected can be 
disregarded, it is not necessary to send the last correction target **** location 
and a posture to an object reaction force balance control device. 
[0098] In drawing 3 , the desired value inputted into an arm Maine control unit 
is a correction target upper-part-of-the-body location and a posture, a target 
hand location and a posture, and target object reaction force. 
[0099] If the function of an arm Maine control device is said simply, it will be 
performing to coincidence attitude control which operates the actuator (others 
[ encoder / electric motors, such as joint 30R (L), and ]) of an arm, and follows 
a target posture, and object reaction force control which follows target object 
reaction force. Since it is impossible to satisfy a target posture and target 
object reaction force to coincidence completely, what is known as the 
compliance control of a manipulator and the so-called virtual compliance 
control is used from proper technique, for example, the former, (the volume 
mechanical-engineering handbook and on engineering, 4-100 pages of C). 
[0100] When a concrete control-system configuration and a concrete 
algorithm are explained below, an arm Maine control system consists of an 
arm Maine control device and a 6 axial-tension sensor 58 formed in the above 
mentioned hand 44 (L), an actuator driving gear 88, and an arm actuator (the 
electric motor for joint 30R (L) thru/or 42R(L), and encoder). 
[0101] An arm Maine control unit corrects a target hand location and a posture 
according to the difference of the real object reaction force detected by 6 
axial-tension sensor 58, and target object reaction force. The corrected target 



hand location and posture are called the last correction target hand location 
and a posture, the target wrist jaw as which an arm Maine control unit is 
determined from a correction target upper-part-of-the-body location and a 
posture, and the last correction target hand location and a posture - a 
variation rate a real joint - an arm actuator is controlled so that a variation 
rate follows. 

[0102] Here, the detail of an object reaction force balance control unit is 
explained. 

[0103] It is the functional block diagram in which drawing 8 shows a part for 

the first portion of the control block diagram of an object reaction force 

balance control unit, and drawing 9 shows the second half part of the control 

block diagram of an object reaction force balance control unit. 

[0104] With reference to drawing 8 , it explains from processing for the first 

portion. 

[0105] First, since it is thought that actual hand 44R (L) is in the last correction 
target hand location and a posture mostly with an arm Maine control unit The 
real object reaction force detected by 6 axial-tension sensor 58 is changed 
into the force and the moment of the circumference of the zero of support- 
saddle system of coordinates by the correction target hand location and the 
posture (by the KINEMA tex operation, from real joint displacement). A real 
hand location and a posture may be searched for, and real object reaction 
force may be changed using this. 

[0106] Next, the real object reaction force moment of the circumference of the 
target all-ground-reaction-force central point is obtained by changing the 
changed real object reaction force into the force and the moment of the 
circumference of the target all-ground-reaction-force central point. Finally, the 
object reaction force moment deflection of the circumference of the target all- 
ground-reaction-force central point is obtained by from now on lengthening 
the target object reaction force moment of the circumference of the target all- 
ground-reaction-force central point. 

[0107] Next, with reference to drawing 9 , processing of the second half part 

of an object reaction force balance control unit is explained. 

[0108] First, the perturbation dynamics model used there is explained. 



[0109] A perturbation dynamics model is a model showing the relation of the 
target all-ground-reaction-force moment perturbation quantity, and the upper- 
part-of-the-body location and the posture perturbation quantity at the time of 
giving the constraint in movement (perturbation) of a target activity pattern. 
While a robot's upper-part-of-the-body posture had been made as an example 
in agreement with below into a target upper-part-of-the-body posture as 
shown in drawing 10 , the model which carries out the perturbation of the 
horizontal position of the upper part of the body is explained. 
[0110] Here, a notation is fixed as follows. 

m: All robot mass g: Gravitational acceleration h: In the center-of-gravity 
height from the target all-ground-reaction-force central point, deltaxG: X 
component deltayGof a target center-of-gravity location perturbation quantity : 
Y component deltaxbof a target center-of-gravity location perturbation 
quantity : X component deltaybof a target upper-part-of-the-body location 
perturbation quantity : Y component deltaMxof a target upper-part-of-the-body 
location perturbation quantity : Y component deltaMGx of the target all- 
ground-reaction-force moment perturbation quantity of the circumference of 
the X component deltaMy:target all-ground-reaction-force central point of the 
target all-ground-reaction-force moment perturbation quantity of the 
circumference of the target all-ground-reaction-force central point : X 
component deltaMGyof the target gravity moment perturbation quantity of the 
circumference of the target all-ground-reaction-force central point : Y 
component [ of the perturbation quantity of the target angular momentum of 
the circumference of the target all-ground-reaction-force central point ] d[ X 
component deltaLy:] (a)/dt of the perturbation quantity of the target angular 
momentum of the circumference of the Y component deltal_x:target all- 
ground-reaction-force central point of the target gravity moment perturbation 
quantity of the circumference of the target all-ground-reaction-force central 
point: Time amount differential d of Variable a () d (a) / dt/dt: The second 
degree differential of time amount of Variable a [01 1 1] A degree type is drawn 
from the definition of the gravity moment. 

deltaMGx= - delta yG*mgdeltaMGy=delta xG*mg ... Formula 1 [01 12] A 
degree type will be drawn if the equivalence moment of inertia of the 



circumference of the center of gravity about a robot's movement perturbation 
can ignore sufficiently small. 

deltaLx=-mh* d (deltayG) / DtdeltaLy=mh * d (deltaxG) /dt ... Formula 2 [0113] 
A degree type is drawn by the Eulerian equation. 

d (deltaLx) /dt = deltaMGx+ deltaMx d (deltaLy) /dt = deltaMGy+ deltaMy ... 
Formula 3 [01 14] A degree type can be obtained as the equation of motion of 
a perturbation dynamics model from an equation 1, an equation 2, and an 
equation 3. 

mh* d(d(deltaxG)/dt)/dt= deltaxG*mg+ deltaMymh* d(d(deltayG)/dt)/dt= 
deltayG*mg - deltaMx ... Formula 4 [01 1 5] By the way, it is thought that a 
target center-of-gravity location perturbation quantity and a target upper-part- 
of-the-body location perturbation quantity are in proportionality mostly. 
Therefore, if a proportionality constant is set to k, a target upper-part-of-the- 
body location perturbation quantity will be obtained by the degree type. 
deltaxb=k* deltaxGdeltayb=k* deltayG ... Formula 5 [0116] As mentioned 
above, a perturbation dynamics model computes a target center-of-gravity 
location perturbation quantity and a target upper-part-of-the-body location 
perturbation quantity using a formula 4 and a formula 5. In the case of a digital 
operation, a formula 4 discretizes and uses it like this equipment in detail. 
Incidentally, an equation 4 is in agreement with the equation of motion of 
height h shown in drawing 1 1 , and the handstand pendulum of mass m. 
[01 17] In the section, the object reaction force moment deflection of the 
circumference of the above mentioned target all-ground-reaction-force central 
point is inputted into the last attainment target center-of-gravity perturbation 
quantity calculation section in the second half of an object reaction force 
balance control unit in which it is shown in drawing 9 . 
[0118] The center-of-gravity perturbation quantity for negating the object 
reaction force moment deflection of the circumference of this target all- 
ground-reaction-force central point in the long run, and maintaining balance is 
called the last attainment target center-of-gravity location perturbation quantity. 
The last attainment target center-of-gravity location perturbation quantity 
calculation section computes the last attainment target center-of-gravity 
location perturbation quantity from the above-mentioned deflection. 



[01 1 9] X component deltayGe of the Y component deltaxGe:last attainment 
target center-of-gravity location perturbation quantity of the gravity moment 
generated here by the X component deltaMGoy:last attainment target center- 
of-gravity location perturbation quantity of the gravity moment generated by 
the Y component deltaMGox:last attainment target center-of-gravity location 
perturbation quantity of the X component deltaMoy:object reaction-force 
moment deflection of deltaMox:object reaction-force moment deflection: 
Consider as Y component of the last attainment target center-of-gravity 
location perturbation quantity. 

[0120] In order to deny with the gravity moment which generates object 
reaction force moment deflection by the last attainment target center-of- 
gravity location perturbation quantity, it is necessary to satisfy a degree type. 
deltaMGox —deltaMoxdeltaMGoy =-deltaMoy ... Formula 6 [0121] The gravity 
moment generated by the last attainment target center-of-gravity location 
perturbation quantity becomes like a degree type. 

deltaMGox =-mg * deltayGedeltaMGoy = mg * deltaxGe ... Formula 7 [0122] A 
degree type is obtained from a formula 6 and a formula 7. 
deltaxGe = - deltaMoy/mgdeltayGe = deltaMox/mg ... Formula 8 [0123] 
Therefore, what is necessary is just to compute the last attainment target 
center-of-gravity location perturbation quantity by the formula 8. 
[0124] a difference with the target center-of-gravity location perturbation 
quantity which the last attainment target center-of-gravity location perturbation 
quantity and a perturbation dynamics model will output if the model control- 
law computing element of an object reaction force balance control device is 
explained — a center of gravity — a variation rate — it is called deflection. A 
model control-law computing element performs control for completing this 
center-of-gravity displacement deflection as 0. An output is the compensation 
all-ground-reaction-force moment for object reaction force balance control. 
[0125] What is necessary is for a PD control law like a degree type just to 
specifically determine the compensation all-ground-reaction-force moment for 
object reaction force balance control. 

compensation all-ground-reaction-force moment for object reaction force 
balance control = Kp* center of gravity - a variation rate - deflection + Kd* 



center of gravity — a variation rate — differential value of deflection ... a 
formula 10 — here, Kp is proportional gain and Kd is a rate gain. 
[0126] If the summation point immediately after the output of a model control- 
law computing element is explained, the sum of the compensation all-ground- 
reaction-force moment for object reaction force balance control and the object 
reaction force moment deflection of the circumference of the target all-ground- 
reaction-force central point will be inputted into a perturbation dynamics model 
by the summation point immediately after the output of a model control-law 
computing element as a target all-ground-reaction-force moment perturbation 
quantity for a model (the amount of model inputs), and the target upper-part- 
of-the-body location and posture perturbation quantity corresponding to the 
input will be computed. This is added to a target upper-part-of-the-body 
location and a posture, and a correction target upper-part-of-the-body location 
and a posture are made. 

[0127] By the way, since a perturbation dynamics model fulfills a dynamical 
equilibrium condition, the sum of the target inertial force moment perturbation 
quantity and target gravity moment perturbation quantity which are generated 
by the target upper-part-of-the-body location and posture perturbation quantity 
which is a model output, and a model input is 0. 
[0128] Therefore, a degree type is materialized. 

Target inertial force moment perturbation quantity + Target gravity moment 
perturbation quantity + The compensation all-ground-reaction-force moment 
for object reaction force balance control + Object reaction force moment 
deflection = 0 ... Formula 11 [0129] On the other hand, a command is sent to 
a foot Maine control unit so that the compensation all-ground-reaction-force 
moment for object reaction force balance control may be additionally 
generated in the circumference of the target all-ground-reaction-force central 
point. That is, it is controlled so that the compensation all-ground-reaction- 
force moment for object reaction force balance control is applied to a real all 
ground reaction force moment as a real all ground reaction force moment 
perturbation quantity. The real all ground reaction force moment generated as 
a result is called a correction real all ground reaction force moment. 
[0130] Therefore, a degree type is materialized. 



Real all ground reaction force moment perturbation quantity = The 
compensation all-ground-reaction-force moment for object reaction force 
balance control ... Formula 12 [0131] A degree type is obtained from a 
formula 1 1 and a formula 12. 

Target inertial force moment perturbation quantity + Target gravity moment 
perturbation quantity + Real all ground reaction force moment perturbation 
quantity + Object reaction force moment deflection = 0 ... Formula 13 [0132] 
By the way, since the target activity pattern has satisfied the dynamical 
equilibrium condition, it satisfies a degree type. 

Target inertial force moment + Target gravity moment + Real all ground 
reaction force moment + Target object reaction force moment = 0 ... Formula 
14 [0133] A degree type is obtained from that each correction moment adds a 
moment perturbation quantity to the original moment, that the real object 
reaction force moment is the sum of the target object reaction force moment 
and object reaction force moment deflection and a formula 13, and a formula 
14 as identity. 

Correction target inertial force moment + Correction target gravity moment + 
Correction real all ground reaction force moment + Real object reaction force 
moment = 0 ... Formula 15 [0134] A formula 15 means the target inertial force 
moment, the target gravity moment, and a real all ground reaction force 
moment being corrected, and always fulfilling conditions 1 by object reaction 
force balance control, even if the real object reaction force moment shifts from 
the target object reaction force moment how, 

[0135] If the same thing is put in another way using a formula 13, even if 
object reaction force moment deflection occurs, by object reaction force 
balance control, a target inertial force moment perturbation quantity, a target 
gravity moment perturbation quantity, and a real all ground reaction force 
moment perturbation quantity occur, and it can be said that the effect of object 
reaction force moment deflection is denied that conditions 1 are satisfied. 
[0136] The behavior of the object reaction force balance control to the 
situation of the truck push activity of drawing 4 is explained again with 
reference to drawing 7 . 

[0137] As shown in drawing, while doing the activity which pushes a truck, in 



the situation which has become small to the shape of a step, object reaction 
force moment deflection also changes in the shape of a step suddenly rather 
than the value which the absolute value of the actual rolling-friction force of a 
truck (namely, target object) assumed. 

[0138] On the other hand, the last attainment target center-of-gravity location 
perturbation quantity calculation section computes the last attainment target 
center-of-gravity location perturbation quantity. According to the difference of 
the last attainment target center-of-gravity location perturbation quantity and a 
target center-of-gravity location perturbation quantity, the compensation all- 
ground-reaction-force moment for object reaction force balance control is 
computed by the model control-law computing element. 
[0139] It carries out asymptotic [ of it ] to 0 as are shown in drawing 7 , and a 
target center-of-gravity location perturbation quantity carries out asymptotic 
[ of the compensation all-ground-reaction-force moment for object reaction 
force balance control ] to the last attainment target center-of-gravity location 
perturbation quantity. The sum of the compensation all-ground-reaction-force 
moment for object reaction force balance control and object reaction force 
moment deflection is inputted into a perturbation dynamics model, and a 
target center-of-gravity location perturbation quantity, and a target upper-part- 
of-the-body location and a posture perturbation quantity are outputted from a 
perturbation dynamics model. In addition, in this example, since it is a 
constraint not to change a posture, a target upper-part-of-the-body location 
and a posture perturbation quantity are 0. 

[0140] By the way, since a perturbation dynamics model satisfies a dynamical 
equilibrium condition, the total which applied the moment inputted into the 
perturbation dynamics model to the sum of the target inertial force moment 
perturbation quantity generated by the target upper-part-of-the-body location 
and the posture perturbation quantity and a target gravity moment 
perturbation quantity is 0. 

[0141] That is, the sum of a target inertial force moment perturbation quantity, 
a target gravity moment perturbation quantity, the compensation all-ground- 
reaction-force moment for object reaction force balance control, and object 
reaction force moment deflection is set to 0. This relation is always 



materialized, as shown in drawing 7 . It carries out asymptotic [ of the target 
center-of-gravity location perturbation quantity ] to the last attainment target 
center-of-gravity location perturbation quantity with a model control-law 
computing element, a target center-of-gravity location perturbation quantity - 
a target gravity moment perturbation quantity — proportionality or it changes 
proportionally mostly. 

[0142] The above is the behavior of an object reaction force balance control 
unit. In addition, all the above-mentioned control operations are performed for 
every control period. Therefore, whenever the real object reaction force 
moment may change, ** balance is always maintained. When putting in 
another way and the object reaction force moment shifts from desired value, it 
is switched so that the upper part of the body may be moved ahead with time 
and it may depend on the gravity moment, while attitude control is carried out 
so that a robot 1 may operate the all-ground-reaction-force moment at first 
and ******** (tip of pair-of-shoes Taira 22R(L)) may be straddled. 
[0143] Drawing 12 shows the gestalt of implementation of the 2nd of this 
invention, forms a limiter 200, sets the limiting value of an upper limit 
minimum as the last attainment target center-of-gravity location perturbation 
quantity, and applies a limit. 

[0144] In the above-mentioned gestalt of operation, in fact, if the last 
attainment target center-of-gravity location perturbation quantity is enlarged 
not much, the case where it becomes impossible to take a robot's posture will 
arise. Therefore, in order to prevent this, the limiting value (range) of an upper 
limit minimum is set as the last attainment target center-of-gravity location 
perturbation quantity obtained by the formula 7, and the limit was applied to it. 
In addition, a fixed value is sufficient as the limiting value (limit value), or it is 
good also as an adjustable value. 

[0145] Furthermore, the 2nd limiter 300 is formed, the limiting value (range) of 
an upper limit minimum is set also to the compensation all-ground-reaction- 
force moment for object reaction force balance control calculated with the 
model control-law computing element, and the limit was applied. 
[0146] That is, although a real robot's ****22R (L) is made to generate the 
compensation all-ground-reaction-force moment for object reaction force 



balance control, if there is a limit in the all-ground-reaction-force moment 
which can generate a real robot's **** and a limit is exceeded, the road- 
hugging of **** will be spoiled or a part of **** will float from a floor. In order to 
prevent it, a model control-law computing element sets the limiting value of an 
upper limit minimum as the compensation all-ground-reaction-force moment 
for object reaction force balance control calculated using the formula 10, and 
applied the limit. It is the same as that of the case of a limiter 200 that 
immobilization or adjustable are sufficient as the limiting value. 
[0147] It forms the 2nd limiter 500 and corrected the compensation all-ground- 
reaction-force moment for object reaction force balance control with the input 
value beyond the 1st limiter 400 while drawing 13 showed the gestalt of 
implementation of the 3rd of this invention, formed the limiter 400, set the 
limiting value of an upper limit minimum as the input of the last attainment 
target center-of-gravity location perturbation quantity calculation section and 
applied the limit. 

[0148] Although the limiting value (range) of an upper limit minimum is set as 
the last attainment target center-of-gravity location perturbation quantity 
obtained by the formula 7 and the limit was applied to it in order to prevent 
that the last attainment target center-of-gravity location perturbation quantity 
becomes [ which was shown in drawing 12 ] excessive in the gestalt of the 
2nd operation The value beyond limiting value (limit value) might be added to 
the output of a model control-law computing element in the summation point 
600 ( drawing 12 ), and it might be inputted into the model. For this reason, 
what resisted object reaction force moment deflection and was carrying out 
the perturbation of the center-of-gravity location might produce un-arranging 
[ which is referred to as rocking a center-of-gravity location to hard flow ], 
when object reaction force moment deflection became excessive and the 
limiter operated. 

[0149] The gestalt of the 3rd operation cancels above-mentioned un-arranging, 
and when it let the 2nd limiter 500 pass and the input value beyond the 
limiting value (limit value) of the 1st limiter 400 was subtracted and put in 
another way from the output of a model control-law computing element at the 
point 700 adding [ subtract and ] delivery and there, it corrected the 



compensation all-gro'und-reaction-force moment for object reaction-force 
balance control so that the force which tends to be made to reverse a polarity 
and it is going to upset, and the force of the reverse sense might be given. 
Attitude control of the robot is carried out by this so that the input value 
(moment deflection) beyond limiting value (limit value) may be supported by 
****22R (L). 

[0150] Unlike the gestalt of the 2nd operation, the value beyond a limit value 
is added to the output of a model control-law computing element in a 
summation point 710 ( drawing 13 ), and it is not inputted into a model. For 
this reason, object reaction force moment deflection which was described 
above can become excessive, a limiter can operate, and it can cancel un- 
arranging [ which is referred to as rocking a center-of-gravity location to hard 
flow ]. In addition, a residual configuration does not differ from the gestalt of 
old operation. It is the same as that of the gestalt of old operation that 
immobilization or adjustable are sufficient as the limiting value (limit value) of 
the 1st limiter 400. Furthermore, a limiter 400 and the same limiter may be 
added after a model control-law computing element. 
[0151] Drawing 14 used the handstand pendulum model which gave the 
inertial force moment I, in order to show the gestalt of implementation of the 
4th of this invention and to raise the precision of a perturbation dynamics 
model in an object reaction force balance control device. 
[0152] Furthermore, if it elaborates about a perturbation dynamics model and 
center-of-gravity height will seldom change, although immobilization is 
sufficient as it, when center-of-gravity height changes according to an activity, 
h may find center-of-gravity height from the robot posture searched for from 
the last correction target upper-part-of-the-body location and a posture, the 
last correction target **** location and a posture, and the last correction target 
hand location and a posture, and may change h according to this. 
[0153] Moreover, in order to raise the precision of a perturbation dynamics 
model more, it has the multi-link geometrical model of a robot with the link of 
****. The center-of-gravity location called for from the last correction target 
upper-part-of-the-body location and a posture, the last correction target **** 
location and a posture, and the last correction target hand location and a 



posture, By searching for a difference with the center-of-gravity location called 
for from the upper-part-of-the-body location and the posture, the last 
correction target **** location and the posture, and the last correction target 
hand location and the posture which deducted the perturbation quantity of an 
upper-part-of-the-body location from the last correction target upper-part-of- 
the-body location and the posture It may ask for the relation between the 
perturbation quantity of a highly precise center-of-gravity location, and the 
perturbation quantity of an upper-part-of-the-body location, and the 
perturbation quantity of an upper-part-of-the-body location may be calculated 
from the perturbation quantity of a center-of-gravity location using it. 
[0154] Moreover, it is the multi-link dynamics model of a robot with the link of 
****, and the constraint in a movement pattern is given and the model to which 
a target upper-part-of-the-body location and a posture perturbation quantity, 
and a center-of-gravity location and a posture perturbation quantity are made 
to output by considering the perturbation of target floor reaction force as an 
input may be used. 

[0155] by the way, the inertial force perturbation quantity of the arm when 
carrying out the perturbation of the arm from a target activity pattern - and — 
or if the perturbation dynamics model in consideration of the effect of a gravity 
perturbation quantity is used, the load of a control unit will become large. 
[0156] because, the inertial force perturbation quantity of an arm — and - or a 
gravity perturbation quantity influences a target upper-part-of-the-body 
location and a posture perturbation quantity - having - reverse -- a target 
upper-part-of-the-body location and a posture perturbation quantity -- the 
inertial force perturbation quantity of an arm - and or since it is influenced 
by the gravity perturbation quantity, it is because a very complicated operation 
is needed to compute model behavior in consideration of this interaction to 
coincidence. 

[0157] The following technique may be used as a means to solve the problem. 
[0158] namely, the inertial force perturbation quantity of the arm when 
carrying out the perturbation of the arm from a target activity pattern in a 
perturbation dynamics model - and - or the effect of a gravity perturbation 
quantity is disregarded and an arm is assumed to be what moves only as a 



target actuation pattern. A model is approximated to the handstand pendulum 
model and highly uniform which were held to detail explanation of a 
perturbation dynamics model as an example by this assumption. Therefore, 
the operation of a perturbation dynamics model becomes very easy. 
[0159] the inertial force perturbation quantity produced from a target hand 
location and a posture, the target upper-part-of-the-body location, the last 
correction target hand location, the posture, and the last correction target 
upper-part-of-the-body location in the arm Maine control unit since the 
perturbation of the arm was carried out to the policy objective posture from the 
target posture - and — or a gravity perturbation quantity is computed. This is 
obtained by performing the dynamics operation of the multi-link manipulator 
which is the technique from the former. This is expressed with the last 
correction target hand location and posture system of coordinates. 
[0160] the computed inertial force perturbation quantity - and - or in addition 
to the real object reaction force detected by the sensor, a gravity perturbation 
quantity is outputted to an object reaction force balance control unit as real 
object reaction force, the above means — the inertial force perturbation 
quantity of an arm — and — or it means taking into consideration as activity 
object reaction force instead of the effect of a gravity perturbation quantity 
being disregarded in a perturbation dynamics model the inertial force 
perturbation quantity of an arm - and - or since the operation of a gravity 
perturbation quantity and the operation of a perturbation dynamics model are 
performed independently, a complicated interference operation becomes 
unnecessary, and the amount of operations is small and ends. 
[0161] If it is in the gestalt of the 1st thru/or the 4th operation like the above In 
the attitude control equipment of the leg formula mobile robot (2-pair-of-shoes 
bipedal robot 1) which consists of a link (the foot link 2 and arm link 3) of two 
or more connected with a base (upper part of the body 28) and said base at 
least Said robot's movement pattern which contains the target locus of said 
base at least, The target locus of floor reaction force which acts on said robot, 
and the target locus of external force other than the floor reaction force which 
acts on said robot are included at least. A target gait setting means (target 
activity pattern generation machine) to set up said robot's target gait, an 



external force detection means (6 axial-tension sensor 58) to detect external 
force other than said floor reaction force, and said detected external force, An 
external force deflection operation means to calculate the deflection (object 
reaction force moment deflection of the circumference of the target all-ground- 
reaction-force central point) of external force other than the floor reaction 
force set up by said target locus (object reaction force balance control unit.) 
More specifically The coordinate transformation of the real object reaction 
force of drawing 8 , and its I/O, The model expressing the relation of the 
perturbation of the center-of-gravity location of the perturbation of said floor 
reaction force, and said robot, and/or the location of a base (perturbation 
dynamics model), An amount operation means of model inputs to calculate 
the amount of model inputs (target all-ground-reaction-force moment 
perturbation quantity for a model) which should be inputted into said model 
based on the deflection of said calculated external force at least (I/O in a 
model control-law computing element and a subsequent summation point), An 
amount operation means of base target locus corrections inputs said 
calculated amount of model inputs into said model, and correct the target 
locus of said base according to the perturbation quantity of said center-of- 
gravity location obtained and/or a base to calculate the amount of base target 
locus corrections (a correction target upper-part-of-the-body location and 
posture) (object reaction force balance control unit.) Input the amount of 
perturbation dynamics model inputs, and the behavior of a model is more 
specifically calculated. The part which calculates a target upper-part-of-the- 
body location posture perturbation quantity (the amount of corrections) from a 
model output, According to said calculated amount of model inputs, correct 
the target locus of said floor reaction force at least, an amount operation 
means of floor-reaction-force target locus corrections (a model control-law 
computing element --) to calculate the amount of floor-reaction-force target 
locus corrections (compensation all-ground-reaction-force moment for object 
reaction force balance control) more - concrete — a part of model control law 
and the joint to which the variation rate of said robot's joint is carried out 
based on said amount of base target locus corrections and amount of floor- 
reaction-force target locus corrections which were calculated at least - a 



variation rate - a means (a foot Maine control unit -) It constituted so that it 
might have the actuator driving gear 88, a foot actuator, etc. 
[0162] Moreover, said amount operation means of model inputs was equipped 
with a balanced center-of-gravity location perturbation-quantity calculation 
means (the last attainment target center-of-gravity location perturbation- 
quantity calculation section) compute the perturbation quantity of the balanced 
center-of-gravity location which balances said external force statically, and it 
constituted it so that said model might converge on said computed balanced 
center-of-gravity location and said amount of model inputs might be calculated. 
[0163] Moreover, it constituted so that it might be the model (perturbation 
dynamics model) to which said model approximates said robot with a 
handstand pendulum. 

[0164] Moreover, said balanced center-of-gravity location perturbation 
quantity calculation means was constituted so that it might have the limiter 
200,400 which restricts the perturbation quantity of said computed balanced 
center-of-gravity location to the predetermined range. 

[0165] Moreover, said amount operation means of floor-reaction-force target 
locus corrections was constituted so that it might have the limiter 300,500 
which restricts said calculated amount of floor-reaction-force target locus 
corrections to the predetermined range. 

[0166] Moreover, the target locus of said floor reaction force was constituted 
so that the locus of the target central point of floor reaction force which acts 
on said robot might be included at least. 

[0167] Moreover, said amount operation means of floor-reaction-force target 
locus corrections Said amount of floor-reaction-force target locus corrections 
(all-ground-reaction-force moment for object reaction force balance control 
compensation) The value which subtracted the deflection (object reaction 
force moment deflection of the circumference of the target all-ground-reaction- 
force central point) of said external force from said amount of model inputs 
(target all-ground-reaction-force moment perturbation quantity for a model), It 
constituted so that it might balance with the moment which acts on the 
circumference of the target central point of said floor reaction force 
dynamically, and said amount of floor-reaction-force target locus corrections 



might be calculated. 

[0168] Moreover, external force other than said floor reaction force constituted 
so that it might be the reaction force from the activity object (truck 100) which 
acts on said robot through said link. 

[0169] Moreover, it constituted so that it might be the leg formula mobile robot 
with which said robot consists of a two feet link 2 connected with said base, 
and a two arms link 3. 

[0170] Moreover, it sets to the attitude control equipment of the leg formula 
mobile robot which consists of a link (the foot link 2, arm link 3) of two or more 
connected with a base (upper part of the body 28) and said base at least. 
Said robot's movement pattern which includes the target position of said base 
at least, The locus of the target central point of floor reaction force which acts 
on said robot is included at least. A target gait setting means to set up said 
robot's target gait (target activity pattern generation machine), An object 
reaction force detection means act on said robot through said link to detect 
the reaction force from an activity object (6 axial-tension sensor 58), So that it 
may balance with an object reaction force moment conversion means (object 
reaction force balance control unit) to change said detected object reaction 
force as the moment of the circumference of said target floor-reaction-force 
central point, and said changed object reaction force moment, dynamically 
The robot location and a posture correction means to correct location and 
posture of the floor-reaction-force moment of the circumference of said target 
central point, and said robot (object reaction force balance control unit), and 
the joint which carries out the variation rate of said robot's joint to the floor- 
reaction-force moment of the circumference of said corrected target central 
point based on said robot's location and posture - a variation rate - it 
constituted so that it might have means (a foot Maine control device, the 
actuator driving gear 88, foot actuator, etc.). 

[0171] Moreover, it sets to the attitude control equipment of the leg formula 
mobile robot which consists of a link (the foot link 2, arm link 3) of two or more 
connected with a base (upper part of the body 28) and said base at least. A 
target gait setting means to set up said robot's movement pattern which 
includes the target position of said base at least (target activity pattern 



generation machine), An object reaction force detection means act on said 
robot through said link to detect the reaction force from an activity object (6 
axial-tension sensor 58), Said detected object reaction force A predetermined 
point, an object reaction force moment conversion means to more specifically 
change as the moment of the circumference of the target floor-reaction-force 
central point (object reaction force balance control unit), So that it may hang 
at said changed object reaction force moment dynamically and it may be 
suited The robot location and a posture correction means to correct location 
and posture of the floor-reaction-force moment of the circumference of said 
predetermined point, and said robot (object reaction force balance control 
unit), and the joint which carries out the variation rate of said robot's joint to 
the floor-reaction-force moment of the circumference of said corrected 
predetermined point based on said robot's location and posture — a variation 
rate — it constituted so that it might have means (a foot Maine control device, 
the actuator driving gear 88, foot actuator, etc.). 

[0172] In addition, in the gestalt of the above-mentioned 1st thru/or the 4th 
operation, although neither bending of an upper-part-of-the-body link nor the 
actuator for a twist was formed, when adding it, an upper-part-of-the-body 
actuator control unit is also needed. However, since bending and the twist of 
an upper-part-of-the-body link are equivalent to having added the joint to the 
root side of an arm or a foot, it can be regarded as the actuator of an arm or a 
foot on a concept. That is, it is possible that an upper-part-of-the-body 
actuator control unit is contained as some control units of an arm or a foot. 
[0173] The other means may be used although the compliance control 
previously proposed by JP,5-305586,A is used with the gestalt of the above- 
mentioned 1st thru/or the 4th operation. If a means to control joint torque to 
foot control using another means other than the compliance control, for 
example, a means to control an electric actuator by the amplifier of a current 
command mold, consequently to control floor reaction force indirectly to it is 
used, 6 axial-tension sensor 56 formed in ****22R (L) is unnecessary. 
[0174] Furthermore, in the gestalt of the above-mentioned 1st thru/or the 4th 
operation, joint torque may be controlled to control of an arm using another 
means other than virtual compliance control, for example, a means to control 



an electric actuator by the amplifier of a current command mold, consequently 
object reaction force may be indirectly controlled to it. Although 6 axial-tension 
sensor of a hand is unnecessary in the control, 6 axial-tension sensor of a 
hand is good to prepare because of an object reaction force balance control 
unit. 

[0175] Furthermore, in the gestalt of the above-mentioned 1st thru/or the 4th 
operation, an arm control unit may be equipped with the presumed machine 
which presumes real object reaction force from joint torque instead of 6 axial- 
tension sensor of a hand. The disturbance observer who is the conventional 
technique should just be used for this presumed machine. 
[0176] Furthermore, in addition to the compliance control proposed by JP,5- 
305586.A, in the gestalt of the above-mentioned 1st thru/or the 4th operation, 
the control which these people proposed by JP,5-337849,A may be added. 
However, in arm control, since the location and step of the upper part of the 
body are corrected by the control, when the relative-position relation between 
a hand and an activity object is important, it is necessary to take into 
consideration the location of the upper part of the body and the effect of a 
step which are corrected by the control. 

[0177] Furthermore, in the gestalt of the above-mentioned 1st thru/or the 4th 
operation, even when a floor is not a flat surface, these people may search for 
the target all-ground-reaction-force central point and Target ZMP on a virtual 
flat surface using the technique of assuming the virtual flat surface proposed 
by JP,5-318840,A. 

[0178] Furthermore, in the gestalt of the above-mentioned 1st thru/or the 4th 
operation, if the whole robot's posture shifts from a target and it inclines, the 
location and posture of a hand will shift in absolute space. Consequently, 
object reaction force may shift from target object reaction force greatly. 
[0179] In order to solve the trouble, even if the whole robot's posture inclines 
by amending further the policy objective hand location and the posture in 
which the above was corrected according to the gap of the real upper-part-of- 
the-body location and posture detected by the inclination sensor, and a target 
upper-part-of-the-body location and a posture, it is more desirable to make it 
the location and the posture of a hand not shift in absolute space. 



[0180] Furthermore, in the gestalt of the above-mentioned 1st thru/or the 4th 
operation, various deformation, such as changing data-processing sequence, 
is possible for a block diagram. 

[0181] Furthermore, although PD control law was used in the gestalt of the 

above-mentioned 1st thru/or the 4th operation, the other control law (for 

example, PID control, a state feedback control) etc. may be used. 

[0182] Moreover, although this invention was explained about the leg formula 

mobile robot of the 2-pair-of-shoes walk equipped with the arm, it is useful 

also to the leg formula mobile robot which does not have an arm, and can 

apply not only to a 2 more pairs-of-shoes bipedal robot but to a multi-foot 

robot. 

[0183] 

[Effect of the Invention] the external force which a leg formula mobile robot 
cannot expect -- even if it more specifically receives reaction force from an 
activity object, ** balance can be maintained and a stable posture can be 
continued. Furthermore, even if the pattern of operation which had not been 
assumed beforehand receives the reaction which is not expected a link, the 
gravity generated on an arm when working by more specifically moving an 
arm, and not only inertial force but for an activity, ** balance can be 
maintained and a stable posture can be continued. 
[0184] Moreover, also when object reaction force changes suddenly, an 
inclination and a fall can be effectively controlled by moving a robot's center of 
gravity to the location which balances statically to it. Moreover, a center-of- 
gravity location and floor reaction force are changed proper, and maintaining 
** balance also in the transition stage which a robot's center of gravity moves, 
can be continued. 



DESCRIPTION OF DRAWINGS 



[Brief Description of the Drawings] 

[Drawing 1] It is the explanatory view, showing the attitude control equipment 
of the leg formula mobile robot concerning this invention on the whole. 
[Drawing 2] It is the block diagram showing the detail of the control unit of a 2- 
pair-of-shoes bipedal robot shown in drawing 1 . 

[Drawing 3] It is the block diagram showing functionally the configuration and 
actuation of a leg formula mobile robot of attitude control equipment 
concerning this invention. 

[Drawing 4] It is the explanatory view showing the activity which the leg 
formula mobile robot which shows drawing 1 does using an arm. 
[Drawing 5] It is the explanatory view showing the support-saddle system of 
coordinates in the gait which generates the target activity pattern generation 
machine of drawing 3 equipment. 

[Drawing 6] It is the explanatory view showing the support-saddle system of 
coordinates in the gait which generates the target activity pattern generation 
machine of drawing 3 equipment like drawing 5 . 

[Drawing 7] It is a timing chart explaining actuation of the object reaction force 
balance control device shown in drawing 3 . 

[Drawing 8] It is the first portion of the block diagram showing the detailed 
configuration of the object reaction force balance control device shown in 
drawing 3 . 

[Drawing 9] It is the second half section of the block diagram showing the 
detailed configuration of the object reaction force balance control device 
shown in drawing 3 . 

[Drawing 10] It is the explanatory view showing the perturbation dynamics 
model of the object reaction force balance control device shown in drawing 9 . 
[Drawing 1 1] It is the explanatory view showing the condition of having 
approximated the model shown in drawing 10 with the handstand pendulum. 
[Drawing 12] It is the second half section of the block diagram showing the 
detailed configuration of the object reaction force balance control device in 
which the gestalt of implementation of the 2nd of this invention is shown 
similar to drawing 9 . 

[Drawing 13] It is the second half section of the block diagram showing the 



detailed configuration of the object reaction force balance control device in 
which the gestalt of implementation of the 3rd of this invention is shown 
similar to drawing 9 . 

[Drawing 14] It is the explanatory view showing the handstand pendulum mold 
perturbation dynamics model similar to drawing 1 1 in which the gestalt of 
implementation of the 4th of this invention is shown. 
[Description of Notations] 

1 2-Pair-of-Shoes Bipedal Robot (Leg Formula Mobile Robot) 

2 Foot Link 

3 Arm Link 

10, 12, 14R, L Waist joint 
16R, L Knee joint 
18, 20R, L Ankle joint 
22R, L **** 

28 Upper Part of the Body 

30, 32, 34R, L Mold joint 

36R, L Elbow joint 

38, 40, 42R, L Wrist joint 

44R, L Hand 

50 Control Unit 

56 58 6 axial-tension sensor 

60 Inclination Sensor 
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^ecr^^x/UT-fe-i. z. £*&&£? zn&mi m&rc 

\t 2 OMPjCfMI P # y h Qg&Mtti&B. 
[fSsRH 4 ] SuIB¥«fi'i>ffiSai))MtU#lfi«v 
k. tai3StbT*'tl/j:¥«B«'i>ffiB<0Si!ia=6mj£(DffiH 
tcftJRrr^yHy*, £^ it" 5 

2Jg$/cli 3^fBe<Dlffllj^aP^"> KD5M9MWS 

Bo 



E**i©«s***Lfc*£* »Ej*E*coa««t>i&ja 
**>y tcftuB-r**-* v h tc»^WK»y «fc a 

So 

mat* si tmmi*j3&LftoMt)t\ wiey>^* 
as* c 1 3a»^L7flio^m* 

[Itm 9] buEp*'^ htf, mBSftlcSASStiS 
2 *CDP UV^i2 y 5 » «KP^Ib n * 

[M«41 10] <fc<fcStt£, fiOESttKiltSf 

ti*Mfc*©y >^*6ft*B«W»P#'y hOSBMM 
W8Blc;&l*T« 

a. mtZntf-y t-<D'Pte<£^mzmi*<DmMiiLmZ:<3 

tswn/i*->ts MEP#f mc«ui?-*j*E7j<ds 

b. ttEy>**rtLTttEP<Ky McfBB*-*s ffH 
ttgl^frSCDE7J£;8ajT£ttSi%E73&aj#l^ 

c. ijE^ttJ^tirc^^S^^BuEB^STJtf'^ 
3: toy ©*-;>< > h i: LT^-r^W^STJ^-^ > 

d. BuE^*nfc^%S7J : E-/>hlcg)^Wlc 

n y J; -5 ic, luEafflitf iC^«to y ©^jg^t-^ 

e. SijE^IETrtlfcS^'^StoycD^Jg^t-yv 
hiII3P*y hcDffiB-^lcS^TBuEP^'y h 

tw^Jii i] 'pr^^t^mwt. mzmmmmsz 
n*«ss*©y v^^e^^PiC^iijp^-y tommm 

a. SuEP<K-y K^)'>^<i: i t>BuESfttDS^Has^^ 

tsmwu - v^tssr * h^siss^©, 

b. BuE'JV^^LTBuEP^-y HCftm?*. ffH 

c. suE^ai^tifcW^s^^m^cD^stoyiT)^- 
•py as -5*51::. BuEm^^stoyro^s^j^-yv 

hiSuEP^'y KDfiiBfc<fctf3S^^iE-r*P#-y h 

e . SiJE^iE* ftrcmfeo&xt) y o^stj^-^ > h 
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[0001] 

«*.*B3HMbP#y h4>n£M®Nimiim»£LT 

[0002] Miilt' >%rflittSAj »t¥B» 

So 

[0003] 

HMfcOSTflS] MnMtD#yK Wc 2 E*M5<DHl5S 

.fey 3»i-^V h*««r*2£*(7n#y h©H 
9SJ (B*P#V h^ifKl 1f»4f > 1 993fp5 

jd jftaetizvs. t<DP*''y ntumittnttmt. 
sweatier* * ? ic#?TS'jffl)-r^o 

[0 0 04] 

[0 0 0 5] 2|s:aJBSA ; t^ ! F7-2 0 5 06 9 

*a«x»Ria<oBPS»»p#y h*a*LTfcyx *c 

[0 0 0 6] LfrLfctfS. *ai«IA<Ml*Lfc«eC» 
^(c*J»*tiTt'»«fe». JKS^iEKj-r^i:. Btf»£T 

[0 0 0 7] loT, d<Of|B^(Da6*lt*±IBLfc^«5^ 
*»Jl!ir*CttC*y» «PiD»BP#y htf¥«W4 

<fe -5 |C Lfc»SC»»P # v h OSB»Cy» 

[0008] n<D&mo)&2 0)mm*. tmnuzMf* 
srst*^ *ntc»wic/^5>^-r*ttB(cP7Ky 



K7>S'i>s»a*-&*c:tic«fey, £$*i&ft$£iBtt 

[0 0 0 9] C09M4>B3«>Bnf& IBlftjWlft 
K2i*g»*fc£*, a#v h9B'b#&»-r«BBft!lc 
iJl^TtK B»&ttB^I*S**ajElcB<fc*-&Tlll/^^ 
>A*BJ*LIW*Sn*J:?lcLfcW5S»MP#y KD 
BIW0»BB*««T £ C <t ic&So 

[0 0 10] coiifiiDff4<0IKtt t WS»ttP#y 

Sift/ <* - V7K*B3^ LTfPH^-r 5 <t * ICMKBS 
■T«B73> «ttaf£W-P*<, fBltt**#S*HH*toK 

-51c LfcWSCB»P#-y h<BBB«HkP£B«£ 

[0 0 1 1 ] 

»wciiis*n*a»*fl!)y >^3^64*wscb»p?k 
ttiB*Katttt<att*>s«ar**i-2i«ai#«» ft 

B&tt?nfett£)&« BIBeaWiBTKJEa-nfclSisKa 

S7J<0Slb t buIBp # y h <Dfi/i>t&S35 «fe tf/$ fcttS 
♦KDttBOaBWHBSBJRT^^^k 'J>&< <!:*>ii5 
IBBBSftfcttaOBBtcB-^TttlB^/l/fcAa*- 
^S^lUAaBfcaMrrs^UArtBBW*®. ft 
IBBWtfftfctT^UArtBfcttElrTWCAaU »S 

BK«*©B«IM**«IET*v SttSBNtiMflEB* 
BITr«B1tsmM*ltiEB9nV¥B, 'J^tttuE 

aw*hfc^5 s ;uA»B(=(SCTWia*s*©eaMM» 

«MM»£jEBBft^& 33«feU\ '>fc< &<MNBBftS 
tlfcgt* a BMRMf iEB£ <fc XSm&ti S B«i»BIEB(c 

[0 0 12] ddT- ITfaMjl It. B*frttB*B*, r te 

[0 0 13] CdT% r«5S730efilDlS)iJI «ty 
BiSTMefflT*. FBuiBJ*£ft<DSSiftSfr£ffIE-r 
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[0014] czt\ mtt^mtar^ tit. &ta© 
[ooi5] m&mimK&iTte. huIb^e^ua^s 

[0 0 16] f§3?^3JStca5oTl*v buIB^xVU^buIB 
[0 0 17] m&mtmfc&^Zte. B5IB¥«S'0tttS 

[0 0 18] Ii3?J15Jllc^oT«v BuEI£E7J@*iill 

[0 0 19] ffjfciI6JSK3&-3TM\ t&EJ*E7J<Z>B«R 

*M**'j>£ < t <&$trto < mm Lit. 

[0 0 2 0] ff3?^7^(CfcoT«x BuEJ£E73§*f?ill 

mirr««i<wAL^. 

[002 1] ftJRJg8JSU:a5o-n*, b5EJ£E7JJ-X$*4) 
$*73*\ HtJIB'J>^^LTHUl3P#-y HcfBirSflF 

[0 0 2 2] WmJS9JSlC»oT«s MEPtf-y 

ttiewwcsHsams 2 *<7)iw y <t 2 *co»a y 

[0 0 2 3] ff^JSl OJSlcfeoTt*. 'J>fc 

<t. BijfBSWcaiK^n^is^wJv^ft^s^^ps: 

Ast>y / > h «h Lra»-r **Hfc*fi*^-y 
>h»»»« ttEBJft*ftfc»*«BEa : E-.><VMc 

■WD^wictt y ^5 «fe 3 ttesm*&>As to y ©j* 

T*P#v MfiE • 5MMKE*«. *5*tftl»EI§IE*ft 
fc@«4>'&ja*foy©*E**-*> h£ttEP#y h 



[0 0 2 4] S89&H1 1 JSlca&oTlis '>*<ttiS(* 
»»P#y KoaWBnPSSBlcfefT* MBn#* h© 

•y Metes*** f^««»»^6©5***mr*«ii 
y ©t-^ v h £ lts^-t *«*»s**-y > 

7J^Wlcoy*-5J:-5lc> «Emft©)SSfoy©J*Ea 

«©£**> y ©fleEfct-.* > h£ttEP#'y h©ffi§ 

* 3B»tc»^Tt9EP?Ky h<DB8S5^Sfii*-t+i)^S5 

*l»*Lfc. 

[0 0 2 5] ±ET\ r»SC»»P5K'y hj tiffiSJ-X^lt 

i«i*«iwcf^fflr *<i©-?»*n«rs w y 

»©2W*jii/'Ttt*l*5±»f*»£n:tts toiyv 

* tiss y v * t * r c 1 1 f %>o 

[0 0 2 6] 

VT'JV^ JiyJIWttlcttWSli^LTfHiS-rSi 

[0027] «jfc»E^fl t *a , r*t*'b» 
ic»wic/^>^-r*tftBicp#-> hom^^as-i* 

* c 4 ic * y » M*^i£fij^^mw(i:«]$ij-r « c t 

*fcx P*'-y KOMi&^ilirSiaaBIIKCfe^T 
[0 0 2 8] S3?Jl2JS?5:^L8^lC*5^T" : b. WsRJS 

i JstiBititofFfli, «bx«#r«. 

[0029] m«a9aKa5?m ±ELftm % 

[0 0 3 0] W5RJ11 oqtttL^LI li»c6^Tt» W 
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[0031] n \*%(j>m3mmu#v to&wmm 

[0032] B^(D$n < , 2 S^tP h 1 1ttt* 

ft^now'j 2 ic 6m<Dmm^mx^ imMoms. 

[0 0 3 3] 6{@<7)B5S5«±^6llitC, M§POKl|slJSffi 
CDB8S51 OR. 1 0L OSWJfcR, L M 

R, 12L> Btfvfi (X«|*t>y) OH8M 4R, 
1 4 Ls ^a5<OP-;H4<DraS51 6 R, 16L, SHP© 
P-yU7JlS]CDII8S51 8 R. 1 8 U * cfcU^tf^ ^$iCD 
H8S52 0R, 2 0L^6«fiKT*-tl*o SflHCttB^ 2 
R, 2 2LA«iXS3-tt£. 

[0 0 3 4] ±IBfcaSt*TKBflS (»«^ttm» it 
MS51 OR (L) , 1 2R (L) , 1 4R (L) frSs 
SHflJttBB 1 8R (L) , 2 OR (L) frSHMMftl 
5„ *fcaaB«Si:«H»tJ4*ffly>^2 4R, 2 4 
U BHtttJEHIBlittTlliyvf 2 6R. 2 6LT'l 

[0 0 3 5] MIC «aM>±(ft[«:tt±tt: (feSlMiS 

(ctt&^n^n© 7 fl<onflsib^«%n y 3 «b 

[0 0 3 6] 7ffl«5MBH4±#SJIKC* JJftf(J!)n-/|,M 
CD^S53 0 R, 3 0U IBtfy ^$SOBS53 2 R, 3 2 

u M(»mt&m<r>m'B3 4R, 3 4u wspop-zubi 

<^BIS53 6 R, 3 6U #ttls!£Jl<DBtt 3 8R, 3 8 
U P|n-;U«©HSS4 0R. 40L, fcJztflWIfcf-y?- 
140^854 2 R, 4 2L#6«/*«£n*. #BflMfe(Ctt 
/\>K (I>KI7i**) 4 4R, 4 4L#tttt;*ih. 

S. 

[0 0 3 7] ±tB(c£^TBBttttBB3 0R (L) , 
3 2R (L) , 3 4R (L) fr6, #mBS5teB!»53 8 
R (L) , 40 R (L) , 42 R (L) frZffimZn 
£o SfcMB»tIhW8»i:tt±Biy>^4 6R. 4 6 
U B*»©t**Ba5tW:Tiiy>^4 8R. 48LT 

[0 0 3 8] ±# (St*) 2 8<75rtgP(Cli, B21C 

[0 0 3 9] ±EO)ttJft[cJ:»J. HV>92tt&fioe 

ico^T-?-n^=h6-p<7)g*js=&-^iieti % $fr<Hcc 
neo6*2 = i 2B©i8Si5£jfii:£ft&7 5 Bi&-r*c 

r*j «*W*3*-r) o ISJs MIB<D$n<, □ Kz>it 



$4, $Bl6;&|pj (BAM) «-Z$ili<i:-r5o 

[0 0 4 0] Sfcs B8U>^3tt^(OaSifC^>t>T^tl 

; eft7ocog&]t£^*.5*u cne<D7*2 = i 4<@ 
»-r * £<Bffia<z>f*B**7 act s. 

[004 1] H1lCS*T*D<» £Mli5CDT73CDJ£¥2 2 
R (L) [Ctt4ja©6*fl-fe>-*5 6tflK»;jr*u □ # 

£J*K73<Z>35|rU##F x. Fy, F z ti-^ > hCQ 
3^|Sjfig»Mx, My, Mzt*«fflr*. 
[0 0 4 2] MIC, #ISIi5t/\VK4 4R (L) 0B 

Lfcttgi%Jg?J<937J|pJfiK#Fx, Fy, Fzt€-^ 
> KD3:£|r]J$#Mx, My, MztSftllin, 
[0 0 4 3] ±<*2 8tCl*1H&Hz>+t6 0#!1SS 

fft, zm obbm mttm ) ic»-rs«*£*<Dft 

>724, 26R (D *£**S*Stt;!r-t»:3£lttc, 
*<7>H]iSE«£1$iiJ?-;5P-* 'JXVU-^tfiSttSftT 

«tt«a»«©M7'^ x-* &^imy<7^3. x 

ttJ^ltiSJffli^.-y h 5 0(CjiS5*v5 (H^<7MM:<D/c«> 

h 1 <D£fl8lc-2l/>T<D*0jj*T*) o 
[0044] 02 itttmn. — V h 5 0 COPUfflS-jjVt ?'P 

«. ^-ClCfc^T<IS«4Hz>tt6 0«:i:<DtH7JttA/D^ 
0T^5?*;MifC***tU ^-^ai7Dti/N"X7 2 
^LTR AM 7 4lc3H5tl^„ $fe*7*fii-* 

ttiTJliv *-7V^ 7 6^LTR AM7 4rt(CA73^n 

[0 0 4 5] IJtozv Hrt[cttCPUfrS**3H»8 
180 fl«RW etlTfc U » 8 0 < » 

R O M 8 4 lC«*rt*tlTl''S*StcS^T P ?Ky h *^ 

(77fH-*Sffti^) *WBU RAM 7 4 
lCj|Stlj"5"§ 0 

[0 0 4 6] gfc9lll£B8 0ttRAM7 4&S*-<>!>ffi 

B«M«P« [Mfn) *»aLTD/AB«W8 6t* 
MBSKKWSn/fcT'^^ax— 5r«fcBB (7 7 >7 P ) 8 
8 ^ LT#»BS*B»-r ^PT 7 ^ ^ i x- * tWT 7 * 

[0 0 4 7] 03(4, c«>Bn(cfl(«WAfMba4tv h 
OB&MWBB (±iLT«HBLfcBII*B8 0(c» 
S ) (D^Sfigfc a l«W««B Wtcsr 7nyf0T'6 

[0048] C0£BfiB££tfn0>nfE&1ft$tt)l;:lH 
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«fHH/t*->£J«B» JfflMfcEaTBIWBBB. BP* 
-fVMBBB* fe<fcira/<>M»«B#S«J**ft 

[0 0 4 9] JSTFIC BIBOBSOfcak B4[cs*ra 
KfHi«3E*ffiHc*»fT, C ©gB©£«§)$gfg© 
SftSrtS^iSB^-r^c B4TB, D#y h 1#&B1 0 

^tfBBttB/tt-Vlcfcl/'TajeLTVfcBBW* 
l^tt^T*, ZOBftOJBBKW&BBtt* £©<fc 

ioo5 0] sBflPB/ttt-vgErtBi*, 
TfcjB^T»a*»mB^«BJeT*B«flBvt*-- 

BBTSBfttsBfrssw-sEasBBrssBfrs 
[0051] ct?, BHMB-rsBRa* erne* 
t*»*. JM*ttKW\ gflije^a • is©, mm ±wm. 

B*B«« BB/\>K(ftB'»»#5Bl«**i*. 

[0 0 5 2] BB#SaW-*fi**BBT*BB 
«s BB£ftEft*<i>a (ttB) (SiZMP (ft 

b> ) . mm±mizt)&&xfmmtm.<fa&i3fremflLii 

[0 0 5 3] CftSfcSRtt* 3»SB«EB*T*fi;!rft 
*o £*$N£BStt« 5JIWgf (BBM 8. 20R 
(L) fr6E¥2 2R (L) ssOSBIMBA* 

Bj£tr**B«T**y» B5£j:&B6icCTrj:? 

IrI*» BB;frlfc±6l**ZBrt]S£*-*BBST'**. 
[0 0 5 4] J-XTtC cnS*B»tCOlvTWB*«B 

[0 0 5 5] buiB<05P<, htfB^frSattSfl- 

[0056] eaMHi/^-vsiastfiii^rsBaB* 
£££4bi;:£oTBBttaii. ^©d^rot-^ > h$ 

[0 0 5 7] BB£«E*l£SB£J5|;E*l*'&j5 (tt 



£*R £Sg<DBB£l*E*JHu B«£*Ert*'&j5i£ 

*©/iWc33W-*:&«-.><>hT*BB*n*. §B£j* 

Eft4"i>AI*. BB£l*Ea**<D/a*fBBjS[£T*a 

YSftSto y * > hftfttf 0 |cft«&B±4>£? 

[0 0 5 8] «SS<DSB£J5RE*Jtt, /£B©BB£J*E 
BB£J*Ert*'&j5£fM3£i<»: LT* -tot.*-* 
>hT*BBLfc*£flW3fc^-/> SB 
f^B/^->^fiKS««m*-rSSB^S73»s 8!*© 

[0059] jumi&(itft9itftti''ny« b«*j*s* 
B±»cR**ns. 

[0060] *ff»Jw<o#»[c*t x Tae*4i»5a«T« 

SZMPOBBtK B5£**<DJ:3Ktt»T*. BP*. 
P*y h<9BBicJ:?T£i;«Btt*i£B*>£&B*E 

& Cl#y l»tfBB©BWl*f53B*«>ZMP*BBZM 
P (ttB) £»R 

[006 1] lBf^/<*->tf»a5S«¥«*f**» 

firstt^cttt. eBtHB/^-vfct-aTSfei:* 
tasizMPfis- BLttitnurft&tti*. 

[0 0 6 2] IKM/^->£iM?fet< K73^W¥ 

t» B«f««/^->*rtWtf4j«r«aB^j*s** 

•£>jdB (ttB) ttSBZMP (ffiB) ic— BrT*. 
[0 0 6 3] aBS¥ffiB-tS»s g^±i*ttB-3g 

SBtfn/fct-n^nowftoMftBtBB^ar. Bf*« 

[CttCOUBUBT** ±i*2 8<0t&B33«fcU : *-<D>SlgW\ 
±tt2 8©B'b1ftBtt£<Dtt££££U : *-a> (Btt) B 
B*»"*-r*o Wlz. ±#fe«tM4ST©iS»«. X, 

y, zbbicjsw-* ntg#j zmmtz, 

[0 0 6 4] W^%S^ 3 F«S'J?aigBfc t tU :; E-(DSiJ^li 

TBCWPKBttBi»/ >X* t * tctblcW)t>¥tfiW L m 
*ft**BLft3tj«6*Uai*ff3. fCT% »B»E*T 
«*JWBB<0«B*l»iwr*ffltc» BA¥ttTO*fMc 

[0 0 6 5] BMM>a4(y h<0B»«*OS)t»*»Sr 

ZMP) SfrVT-nmi&OltlO^-* V KD/«>X? 
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[0066] mM£mfx.t) t P>\j}SL£t>vfcifrm?z>t><D 

1) Bisa^-yvh 

2) STj^-^Vh 

3) ^ETj^-^Vh 

4) ttfittK^-^Vh 

[0 0 6 7] lX±©^-*>M*ft(CfclttlBL/-;:Jb\ 3* 

[0068] mfett-tyhi*. mm^m&t>tp>b& 

*y\*T'&2>* Z.OW,*** 7-7JfI:ENc £ fcoT#«>e> 

[0 0 6 9] g^fPH/N^-VCDWttTJ^-^Vh^ 
Tl^5<!:£ ©If liTj^-* y h£H1f ItTj^-* > h £: 
[0 0 7 0] ST^— h©g<D>lCf1UB 

[0071] &&mcftm?z>miRjj<D'£t>*. £j*e 

[0 0 7 2] f^«*f»KB!^6»»t*S**s *»*52l 

[0 0 7 3] JT, ^WfcBMYVMWBBfcJ:-? 
T> h 1 ft&mftW - V©51®)/ \°* - XCJS 

-*>M4B««1£*HE-.*>Mi:-»U 

[0074] -75, »*^<oaw (*-f5-»aiC) t= 
[0075] sue, h 1 #&mtcB9rmt<*- 

[0 0 7 6] SRHCtt* *»*»S*^-/ 

> h «<B«B«t*E7J^-.?< y k t-»*r*<j«* u 
5. MX.I& 04lcKILTaS^fc«J:-5^ 6»*l¥fflP 

kcdc: y mftQMftNHMue LTi^tt* y 

[0077] c *****jE;&#Bii£ 
jsicK^i&jacoYiistoyjcf^fflr^^-yvn** § 



h©(pj*U\ BBMQIE&itgiciRi^Tatf? h i *B*tt 
y icing a-H*-*^-* y h *jE£T*. 

[0 0 7 8] COJ^ftKSEKS^TfcftfM fcjSJET* - 
-£3fc46(Cli* &© 2 j^J ©#»##*. StlS,, 
[0 0 7 9] #^1) ±l3ffl«*fir-65l!irJ:3ic» 

^/i>js«t>y icnvm&ii'E-* > Y-*m%.?*> * 3tc 

T» C<D»**gi7T\ ST 2 2 R (L) ©OS£^£ 

BP'S, £7»A/»*d:3*a!»=6i:6-a:*. 

[0 0 8 0] ^2) ±B«l*ir6iIirJ:9lC» SB 
f^/<*->©BM/<*->*BiET*C4:fcJ:y» B 

[008 1] C(OHtt0fl$ffi(Cft«£B?ttP^0#S 
TBi^EfWcfcHSU SSSWlc«*;S 2 fcilctt? C £: 

icji'azx&msui*-* y v*7t<»mm£.fcs.ii=E- 
[0082] m^m^n^-^ybit. 

#SS 1 ttfflJ»tt»*t 
I&KIrH^TVSo fiU 5I^J*S73^-^> h£** < 
S4b£-fr«&« S¥2 2R (L) ©Sitiff^^ticT 
«*S«« s J* / >Lx «^©Ji^tC«S¥2 2R (L) O- 

[0 0 8 3] *£|*K73^-yVh*7C«>B«l£J*E73 

7J ; E-y>H!:j;oT±iB<sM^n-5>Wrj:dli:, #a 

2 ic <*: -a t smim/ - y<omw)/ w -y^mm 

[0 0 8 4] ±G*mi& LTttfllttSA^PWMWKB 

[0 0 8 5] »ftttEA¥ffiCi]«KSIBa)AAtt. 

VMxt). 6$ft73-tr>-9-5 8 CD^IttJ-fiS. MSttlESttt/W 
KfflB ♦ §Sf». «Mf]EB«i:1MftB • 9B». fi^IE 

tts «WKEB«/\V KttB • §B»» B«BjESB±1t: 
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gib • ss^ s&teiEgrae¥<&B • &mt*mz*& 

3) o 

[0086] *tmynis.t>w-mmgi&-?te. ±&mm 
[0 0 8 7] nmnK-h^m^mtmoi^-h\t. ikes 

[0 0 8 8] ttiESBJiitttB • 3B»B» 
««KBl««(cJ:^T*iE*ti^:B«P±(*ffiB • 

TJ^'CvS (ffiB) ICs {£IElC<i:^Tlra*.S*V5£j*JS7J 

toy t-^ > h*»t y«* toy t-^ > k«»t* 

So 

[0 0 8 9] ttmB&*>w-m%\w&fr<n\ht)(ommtiu 

VIEmcit?Qm<D : E-*>b<D1SMtS i £&s IP'S, 07 

[0 0 9 0] *<D'&U£e><?Zt. ^iEg^±f*fitB 

U hi* 
»«0(ciK^fSo ft, »BWEAT«S!l«i«B(0«Mi 

tr/nj'j XA8t*n*«as*-*. 

[009 1] H3ltJ5^T. B^OWattSBfCA** 
ftSSftBli* BIElflLtttl&B • §Bf»* BBETfflB 

[0 0 9 2] B/YV«iJ8PSB0)ttB». Wmicm?^ 
Stt\ P<D7"7^3.x-'? (HIM OR (L) ts.Z<J)W 

*hbsu:*75«b?**. mmm&tsmm&n* 

[0093] £»JI¥L<& «WSH2V«r6 0U:j:oT8 



(L) ^0lEfeStMi±T»)*-y- ; 5^O^S I FfilB- 

flglEBHETt&B • 
[0 0 9 4] fi£oT* «IMrV1*6 0lcJ:-3Ttttii*ft 

£Si±ttt&B • a»t*©»w^ «fjEi«±fMttB 

*4>'&ja«ttBlcflPffl , r *»£flcE*>©^-.?< V H«#tf 
fc©^-/> hJ»#te-ST*J:3(CB«je i IMftB • s£ 
[0 09 5] BP** VMSlgBl*. *£IEB*g± 

smNBMKBiiasxtttfafler * * -5 kibpt 7 <? * 

nx— S^i&JWSo 

[0096] p * 4 >®mmm * <f v tdttSB. & * 

tfl»reLfc«WSH!V9-6 0» S¥2 2R (L) KBKtfc 
eiMj-tV^S 6, 7"?^iX--?|gi!)gS8 8££tf 
7^? 1 2l-5 (HIM OR (L) ft^L20R (L) 

[0 0 9 7] W/-f VWftlSBTBiEirtlfeBBeTtt 
B-iSISttx B^iESBSTttB • §5»<t LT*t&*iB 
B*¥B*JWaiB»c2S6*i*. BU *f3tf&E73 s WS*'J 
WKBJcJifTv SBSWftB • SMMWilESmfcC t 
lc J; £ P # y h ©«/&ffiB©»b#B«T , S * ft 6 & 
•B#jES«STttB • SMSfcttBtoSJi^HraOWSB 

[0 0 9 8] H3lCfel>T, K8*-f>feJfflJ£IBlCA7J* 

b • 3B»i* amttBttE*?**. 

[0 0 9 9] My^V«|»jBBa>«MettmB(CB3ft6 
«\ KOT'^a.X-* (Kfi53 0R (L) St'Oil 

SBB»^S«»B«S^)« 
|p|^lc^lcjiSSS*-t± ; 5c:<tt*^plB6T-fe-5.CDT\ iBS 
ft#;£> flX.& a**»5^tfaU— 5K03>^-f 
^to«>*ffiB3Vr5-f7'V^i6yWtLT 

^«Ss C4-100I). 

[0 10 0] mW&ftWWJRBffii^UzT'JXASfWT 
icifts^-TS.*:. Bi/'r>»J»*ttii>-f>*J»BB» 
J:U : BuiaL/c/\>F4 4 (L) lCteitfc6l473-t>-9- 5 
8, 7?f2l- ?iEDigB8 8*5d;0 : ffia7"5'^iLX- 
^ (^S53 0 R (L) S^L4 2R (L) fflHSlt-^ 

[0101] M*-f >»^Bt*> 6lft73Hz>+>-5 8IC 

(6UTa«/\>KttB'aa**«iEr*. <siE*nrce 



(9) 



&ffl¥--\ 0-2 3 04 8 5 



tmm^JESW\y k<6b • 5S^* % 6>*s*n^s^»s 

[0 10 2] ^ft»5A¥«CijaKSIK«>ffm« 

[0103] asammRtiwmmmmmmma 
[0104] m8zmmLTm¥&ft<D<>ikmfrem.w? 

[0 10 5] $tr\ *P£CD/\VK4 4 R (L) it. El* 

■QT«aj*nfcH»^t!os^^> ^jebhimv Km • 

[0 10 6] :*lc, SHft*nfc***ttE*>*» Sfl& 

ftEa*'&j£*t>y©*£*-.?<>Mc£*T*cfcfc 

y©a«B**WE*t-/>h*9l<CtH:J:y» Btn 

«. 

[0 10 7] %Kia9«#!!aLTtt*ttEftTOM*lg 

[0 10 8] $M\ f-CTJBl^aiMWJ^^/MCO 

A MG x = - A y G * m g 
AMG y = A x G *mg 

[0112] hoanbSHKcnrsB'&sfeyto 

A L x = - mh* d(AyG) / dt 



u i_ « ...... « v« / *-• / / 

ALy=mh* d(AxG) / dt 



[0109] an*^7int a«f*«y<*->© 
sift (mm \z&z&$ijkft*5-z.T3s^rz®'£<D. a 

omKS-rc^ii/T*^. wtjc, «£lt\ hi o 

[0 1 10] CCT\ J.)(T<DJ:-5lciB^<fcy*»*. 
m : p*y h£ftS 
g : S jjfiPilS 

h : gff£ftEft*'i>£&6a>a<ttC3' 

A x G : B8iS't><&S}5»S<&Xfifc# 

A y G : gfltt<bttBS9fcS<DYJtt# 

A x b : BfI±«SgJg®!iS<r;XfiB# 

A y b : Bg±ftfil«110Y^ 

A M x : B«£«Ea>*>'&j5Sfoy©B*£*5*Jt- 

^VhSli&ft^Xfigtt 

AMy : B**J*fi*t>i&^iSt>yoa*P^I*E*t- 

AMGx : Sfl&lSEft4*&jaSt> > J0BflnBj J E-.7< 

AMGy : IWaSEfc^'DjSSfoyOBIltt*!*-* 

A L x : Sffig^ftip'bi&SfeyogWAillMOlS 

A L y : B«^l*E^*^St>y<DB®ft5ISbfi<7)a 
»«CDY^ 

d(a) / dt : £Ka<Z>e«nf&# 
d( d(a) / dt) /dt : SftaOBm 2 P§?*tt 
[0 111] ft£)^-j<>h«>£«*P6s $&ffmfrti 

So 



[0113] ?i--i' : 7-75igieicj:y. #35#»mi*. 

d(ALx) / dt = AMGx + AM x 
d(ALy) / dt = AMGy + AMy 

[0 1 14] SCI x 3C2££tf33J:y> mWlWllJ^ 

mh* d( d(AxG) / dt ) / dt= A 
mh * d( d( A y G) / dt ) / dt= A 

[0 115] tC57, BflntiMftBSaW^BflLblti 
Axb=k* AxG 



■SC2 



• • -SC3 

x G *mg + AMy 
y G * m g - AMx 

• • • iC4 

T> tt,ffl7£$Sl*kt?Z>£. *A(cJ:yB4ILk#ttB.a 
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Ayb=k* A y G 

[0116] j-x±^5, mmmti^rMts lUtst 

iC4«g|^bLT«ffl-r?>o ttfrlc. 5*4 
W\ E11 MCTjkT. iS*h> Mftm(Dej3lffi?WJl»l^ 

[0117] m9\z^?nmBfctiW<mm%m&i*& 

iCATJ^tlSo 
[0 118] ClG)g^0l?S^lf^^toy03>t&!KDS 

A M G o x = -AMox 
AMGo y = -AMo y 

[0121] mmmmmm>u>GL^mw)mic<k-oz%£. 

AMGox =-mg * AyGe 
AMGoy = mg * A x Ge 



e mmm m 8H<&>ttusifea*ff tar 

[0 119] CCT\ 

AMox : ^teS^I^-^^hdScDX^ 
AMoy : W^S^I^-^VhiBMCDY^ 
AMGo x : «&£SMg#Sikffi^ffi»§KJ;-pT$i£ 

AMGoy: §^iU^ltiSn>ffiB«iSfll;:<J:oT#S£ 

a x Ge : gsisijiie^fi/i:sffis«Kia(DXfiE» 

AyGe: §*Hy>IgtiS<i><3iBlg®]»4) YfiEtt 
[0 12 0] W^S^t-^Vh^^^SJJig^ 



• • -SC6 



[0 12 2] 5£6, 



35 7 <fcy*SC*»*. 
A x Ge = - AMo y/mg 
A y Ge = AMox/mg 



[0 12 3] SfclC, l^JiSil^iiiid it 
[0 12 4] ^«5AT1fi«iJ»SB(0%7/l«<jaiM-3k 



3£7 



• • • 5t8 

[0 12 5] UttWlcte, &£G0!)j;3tt. PDW»BU(= 



[0 12 6] t^H6iJffllW3lgSCDaj73iamcDfiDm^lC 
ov>TBWiT S ^/l/tymuailS-OltlftBttO&D 

*J»«lII«£j*K73^-.><>h£* B«£*K73+'&j£ 



• • • iC1 0 

[0 12 7] <hC5T% aiftKlTJ^t^HiibTD^WV 

[0128] a»c, astfjaicT*. 



hflSS = 0 

• • -3£1 1 

[0129] -is. m^>wtmm.\cttis mm^ms. -/>h*f*»»tca^-r*<fcdicjB*fl 5 jassti*. in 



(11) ^¥1 0-2 3 04 8 5 



yv 

[0131] iCl 1 <tiCl 2fr<=K *SCjW»6ti*. 
[0 13 2] tC5T\ a«ff«/^->tt«l»^W¥ 

e^iait^^-^vh + mm 



[0130] ttic &£tfAftr«. 



iCl 2 



= 0 
•xtl 3 



• • • iC1 4 



[0 13 3] S^iEt-^V h^TuO^-^VhtC^- 

• • • 5£1 5 



[0 1 3 4] SCI 5 lt x mm*5tt-*yb#vtt' 

[0 13 5] P— (DC£*SC1 3£ffl^TMl^Sl*.3 

mmti=E-^y Y-m.mmss^xjm^ms.ti^-^y hm 

[0 13 6] BI4a>ftW Lf^«<Dtt3EtC»r*«»* 
[0 13 7] £**»Tft**ft"3Tl^S£*» ^» 

[0 13 8] CfMCttU mtStiSSaH&ttHSIbft 

[0139] W7icm?£?te. timmsLiiwwmmm 
mm^mfrti*-* y y- it. mum&m.m.mwim&mm 

mELte-ty h t«»»S73*-y y maoa^A 
a& fflMWjsa^/i/frsmasn*. ft> coat 



[0 14 0] a«»*¥ : E7 ? /U*i { «l*¥W J F 

«f*fl«aisr*c tee. g«±<*tss • 
u: «* o t * a ««1473 "E-^ybmmmtmmm 
tt-tyy-mmmoymc. mmmti^TMcAtiz 
ntc^-^y b^mxtcumitoTSr,^ 
[0141] are, awmtt^-yvnafta^ ati 

[oi4 2] m±tj\ smmRtiw-tmmmmonmT 
Wie*^-* y asm^s-mfci:* . m 

22 R (L) <D5t4£) «MA/3R&<t:3(c£&it!NB;<rn« 

tmc mvzm^teZffijDic&mz-eTmtt-ty 

h tc|S5 J: lc<S0 y 6 n«. 

[0 14 3] 1211 2Ui:0!iRC9X2«)Slltoett«/T 
U y5y*2 0 0*Rti\ SttlliiaflnMMfrHmb 
»c±HTH<D*JH«*I8JELTy S* h£<>Ht**-3 

[0 14 4] ±ElfcJfcl|4»gtt(C£l*T, KHtlCtt« 

«»S!iiia««i&ffiii«i«*a5*y**<r*t» n 



(12) 
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#7 \-<Dm&tft*irs<.t f 2>t§'£ft£C%. ft^T, C 

>otiL&mmmiz. ±mTm<opmm mm) ^isslt 

'J 5 -y h^*Ht* J: -5 ic Lfco fS. *0>«jn« 0J 5 y 
[0 14 5] MIC. S2©';;7?3 0 0?^ ?f 

ip»jwj3w»Tatii*nfe»ai*fi*¥WJWffl*i« 

tffS*^-^ V KctlffiTKOMiii MSB) £IS 

[0 14 6] spt>, ttmm&t>wmfwmmm±m&ii 

i-^>HiHP*7 h©S I F22R (L) (c«,ft£S 

a*fcnfcy, jet©— tfi^^s^fcyr*. 

*B5<*fc«Mcttx ^x/l/MWMBllStfSC 1 0*£l*T 

(c±HTH<D«dH1iI«l8BU 'J 5* h 9 (C 

2 2 0 0©S§iH»?S5. 
[0 14 7] Ell 3ttC®8ISQ£3a£tt0)Jgn»i3i 
y 5 y * 4 0 O «Bl*TSftl!J£gffB'&ttB»lb 
B«ai»fl!>A*Uc±HTH0MH«*Kje LT 'J 5 y h 
*»tt«£KlC. JH2O'J5y*5 0 0*K^ *1<0 
y 5 y * 4 0 0 *lffl*fc A*tf XWftHlS^TflStiJWffl 

[0 14 8] bm 2icmLrc&2<z>niM(Dfi}mctsvT 
saaatc, ±PETPM<D$'ji5Bffi ran) ^is^ltu = 

y h*6H^«J:-5tcL/-cft\ MRfl (ySyHi) £S 
^fdi*^x/U*y^W>llgS©ilJ73tC»P»,-S6 00 (@ 
1 2) iCfc^TJlQmTlrtt. t^HcA^lJn^Ci:*^ 

BftifcttcftUx y5y*<WHftT*£s 

[0 14 9] m3©*fi6<DJBH«±f5Lfc^ilJ^*«jB 
-rS<k©T\ Sflicpy =-y*4 0 0(S>{6!]Pgfi ("JSyh 
ffl) *jBx.fcA73ffl^2©'J 57*50 OfciiLTJjQ 

WtioT, P#y hlttHBtf (USvH) 

A73fB (*-*>h«B) ?£ 5 F2 2R (L) ZWT 

[0 15 0] K2 4>£B<D&8£Atty, >JS9hft 



(013) (C&^Tttft$ftT^7 f Jl/(CAft3'ft«C& 
hfflBtf a*tc*oT 'J 5 v*#ft»U BtottBfcifi 

ss»e» GTiw&mw&maMkiz* ys 7*4 

0 0 <klll«<7) 'J 5 y * ^iiJjP LT.fcglA, 

[0151] mi A\tz.<D^mom4(omm<omm^ 

7*/l/«ttBr § J: o lc l r Co 

[0152] attBa^y/i/jco^TBfsr* 

fH(«cj:-3TB*D«*#Sfo*«£lcW:» ittn 
iES*I±#t&g • 3B&« BKBIEgfllJeVttB • sS&fc 

y hSB»fr5B«&K;Sr*#4&» CftteJSUThfcBKL 

[0 15 3] *fcs HOfttta^x/WMIISfc «fc y B46 

^t^U^tix, BttftiESIILhltttB • IBB* 
IEg^S¥<aS • tfBBBjEgft/W KffiB • 

B»frS#«&S*i*B'iMftB£» B£BiEStt±1*ttB 
• B»#S±f^B<0ffl»B*BL5ll^fc±fMftB • 

Ct(cj;»A BI»B«Bii>(ftB<D8abB&±1*:iaB(0ffi 
»«t<OB8«*SW6, f-n*B^TB'&ffiB«OBHft»fl» 
6±tWttB<0»a«lB**46Tt.fil\ 

[0154] s/c, mm<DV~s<7*i&ontfv h<o*y 

^^Tfcl^Tx BW*B*<0«ill*A*tUTB« 

±<*fas • 3S»a®is«tS'i>ffiB • 3^aaa*ai73* 

[0 15 5] M*B*tHi/^->^68ab 
S-&fc£S©W©«tta«»Bfi«fctf*fcttB*l««lB 

B<0B«fl«**<**. 
[0 15 6] fpjftfcS. B8©1S , t47JSElS*3<fct;^fc« 

B73«ib*«s e^±#ttB • &mmmmic&wz n> 
«fcif*fc»B*a»«»cB**n*o"P» c©fflsf^B 

[0 15 7] *<DH)H*«I8W-*#B£ LT, i-XTO? 
B«B^T«Bt\ 

[0158] m.wm-h^Tiwt. mzmmft 



(13) 
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if* rcimt)mmmo§zwzm$L u mt sm®Yv 

[oi5 9] mt-oftmgimiz&^z. sw/\>Kift 

y v= t:^ u— *<DW)fi¥mn&n=> 
[oi6o] m&ztxtcmvktimwimtexvztcimt) 

TSo J2(±<Z>¥«(::J:>A M<D1ll1fc&SaMreJ:USfc 

[0 16 1] ±§B<DftK, ^UfULS4(DH«(6©)K« 
icfeoTt*. '>%<<l:t»Sft (±f*2 8) <fc, HufBSfls: 

* MiestttD e «Rtu»«$&£Ki/ \°* - > t , Suf a a # 

y McttBT*J*Kfla>B«llM*<!:» bu§Bp#')/ Heft 

fflr*j*s*w«.fl>«.*<oaa«w»i:* / >«:< 

*«Wr*tt*l«U*« (6$47J-fe>+*-5 8) , SusB^ 
Jg^l¥^J«BlgSo «fey*i*WfCtt» 08Wll«^!R!lS 
< t t> *ul3«S* nfc^^OJisMlcS^THylBtx^ 

(^ 9) mwwmn&3$ * a-* ©t© jjqs^t© a* 

73) . HulBJim^nfct^UA^fi^HufB^^UCA^ 

icrsuTBufBSftcDg^m^^iiiiE-r*, si*s«niiu» 
i«iE» (^iEs^±#<a§ • *$ss-r*g<*@is 



tnMftWU ^/Utii7Jfr£gtI±{*fiig3gf*SIBj& 
(*£IES) £#4&£gStt) , t*,&ji33ttl;*ftfc 

^xyuA^jfitcrs ctbu§be*E7j© gamut*** iet 

mm®,Wfi®iEm£i&xfmKt) mmwum latest t 
[oi6 2] mtc, mttTfrAtimmm^mt. hjib 
SuiBtx/i/^jR^-r^ d: •? ictijiB^^/uA^a^s-r 

[0 16 3] Xtc. BufB^T^tfjtuiBntfV h^mum 

[0 16 4] zrc. mvs,wm*<t>iSLmsmmmm^m 
it. HuiBffajxrnfc^fi^ffigoaiftfi^m^cDiSH 
icjijpg-r y = -y-5f2oo, 400 ^tt^^fta < mm l 

/Co 

[0 16 5] £/c, MfB^K^a^iDl^iESjSW^IS 

tcWHT * 'J 3 y * 3 0 0 , 500 ^11^.^ J: 5 

[0 16 6] Sfc, BUlB^S^KDemBHix H5IBa# 

■iNj&KfifiBLfco 
[0 16 7] BulB^STJB^SlSf^iEfijllS^ 
MfBJ*S73B««l»^IEfi (Mfll»S^T«MttiM 
Mffl^STDt-^^h) *\ BUlB^^l/ATJfi (^^ 
^©/cttXDg^^STJ^-^VhffiBjS) 6^6b«}I3^ 

MiB*S7jam^iE«^ss-r^<ip<«fiEL 

/Co 

[0 16 8] Sfcs Bul3)*J573l-X^-CD^7J6\ huIB'JV 

0 0) ^6©S*T»*«<««Lrc 
[0 16 9] ^fcs NBD#y h6\ B5iBSftfca«g3- 

2*©py y<? 2 1 2*©iwy >^ 3 

[0 17 0] '>*<tt.W* (±#2 8) M 

i3S#ic»®S'*is«!a*<D';>'j' mv>*2* »sy 



(14) 
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(6Hfi^Hz>+»-5 8) % B5fB«m**X/c^*5)S^* 
BuiBS«flcS*«f'i>/§« toy ©=E-p< > h £ LT^Jft-T 

tticft y «fc a it, tot BB^f i&jss to y cd^stj^ 

h&b • &iMtiE#Ht mmDis.t}W-m%mgk 
s) x fc^o-iiJiB^iETrn/cs^tf^^toyo^s^ 

^-^V httufBPtfV hOffiB • ^IcS^TbusB 

SPSS* T'^ii-^lBiJi^BS 8, i7^fn- 
*&£) » Sfli*.«*D<Mj8Lfc. 
[0171] 'Pte<£$,Ste (±<*2 8) «t 

HBWwc>ns*n*a»*<oy>^ wr^2, m>j 

>*3) fr£ft«IP3*ttn*'J' hOSKMMII(c£ 
l^T. BED*? hcD'J>&< tt»HuI3Sff<Dl«fag^ 

I£m° *->£/$!§) , MCy V^t^LTMBP** h 
ffiBfc«fctfi6»*BIET*ci!!J«->' MSB • S5»BIE#» 

(tt**E7Wttt<j»sB) * ^J:t>"BuiB^iE*nfcm 

SOMi^toyoBRS^l^-/ > htS5IBP*'u/ hcotitB 

8 8, W7***:LX~$rfc£) v £$D< tl/SL 

[0 17 2] ffi, ±IBLfcmi *V> LB 4 

T^f-a.^-fwammtamtit^o bu ±f*y> 

L/cdi:<!:#ffi-c?i6^cT)T : \ «SUi» IWie/i:t*Bipc7)7"7 

B* ft* t 3 C £ 0*T'# 
[0 17 3] ±«BLfc»1 tt^LB4 4>££<DJBtt-? 

t*> mcnmw-s- 30558 6*£B?££Lfc3> 



l^fttf, Ef2 2R (L) lcS9ltfc6$dl73-fe>+*-5 6W 
[0 17 4] 5»C, ±|BLfcB1 ttU>LB4 0!>Bft(Dm 
fl-CDS'JO^&x BKl7'9?:ix-*&BBfB 

BL\ *OWWTf*/\> K©6*d*-t>+f«:TKT»* 

[0 17 5] »C* ±f3LfcBl ftt^Lm4ro*fil!C7)m 
BlCfcl^T* /N^KCDeiiTJ-tV-tWfttoyiC. |R|g5h 

ju*fr5£ttfe»sft*£sr3££H&imjw&BK 

[0 17 6] Mfclix ±IBLfcBl ft^L*4©*fiS© 
mmiZte^T. - 3 0 5 5 86tfl«L).a 

>:/5*7»>ZM«-U:illl7lTx *MAtfW5-3 
3 7 84 9*aB?«*LfcMW*J!in*T , fefit\, fi 

©ttB*iWB©B»*#*T*«M5tf»*. 
[0 17 7] MlCiiv ±IBLrcB1«^LB4(0^BO 

g|¥5 - 3 1 8 8 4 0*45«TBBLn:<BB¥ffi*a!E 

r«««*«t'»Te«*j*S73'*"&^a«zMP«fi 

[0 1 7 8] MlClix ±IBLfcSl ^Lm4<DHjSfeCD 

[0 17 9] *<Dm&£L*M}}i?2>rc6b\c > (B^-trV^ 

*»©rtl(C|tSCT±IB(OBjE**l/S:«l»B«/\> Ktt 
B'SM***SJc«IE-r*Ci:fcJ:y» n#y h^tt© 

[0 18 0] MKte, ±fi3L/cmi ^t^Lm4c7)IISt5v7) 

[0181] Mlcti, ±S3Lfclg1 fcl/»L£4©*86<D 

[0 18 2] C©»W*K*«*fc2E*?f©W 
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